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tifying parameters in ocean vehicle nonlinear dynamic mathematical 
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nonlinear vector differential equation mathematical models for the 
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These models are extended to include fluidic memory effects and 
Magner order derivatives. Next, the specific equations for the two 
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vehicle models is explained in great detail. Then the two identi- 
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for a large number of different types of input functions and noise 
characteristics, After presenting the detailed equations and Fortran 
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several selected coefficients are identified using 1, 2, 3, 4, 5, and 
6 depree-of-freedom simulated sea trials and the results are discussed 
and compared. Finally a complete listing is provided of all of the 
identification computer programs used, and a bibliography of 276 
references from the areas oi system identification and ocean vehicle 
dynamics is included, 
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CHAPTER T2 


CONVENTIONS USED IN THIS THESIS 


This chapter lists in a somewhat random order a number of 


explanations of the symbols and language to be used throughout this 


thesis for the convenience of the reader, The ideas and research 


presented in this thesis run from the very general to the very 


specific. 


Téel SYMBOLS USED 


‘ 
x 


<i 


dot over a letter means its time derivative d/dt 

underlined letter means it is a column vector 

ever ined Vetver reters to its mean value, [ x | = X 

jetter x can stand for x as a variable, a function x(t), 

or a number; x also refers to forward distance traveled 

by a vehicle (ft. ) 

Capital letters in equations represent either specific 
vehicle coefficients or general matrices 

indicates the transpose of the matrix A 

indicates the inverse of the matrix A 

indicates the inverse of A” 

refers to the mean value of the random variable x 

refers to the error covariance matrix used in Kalman filtering 
vehicle surge (forward) velocity (feet/second) relative to a 
coordinate system moving with the vehicle; u = x} in the 
general state vector x 

vehicle input function such as propellor revolutions per 


second; u is used as an input variable in all state space’ 


Oe 





equations where the vehicle surge velocity is called Xy° 
v vehicle sway (sidewise) velocity (ft/sec); v = Xo in x 
Vv measurement noise input function for a state space ocean 
vehicle model, Hv] = 0; v, = v(t,) for discrete samples 
w vehicle heave (vertical) velocity (ft/sec); w = X in x 
W process noise or input noise to the vehicle for a state space 
ocean vehicle model, E{w] = 0; w= w(t) for discrete samples 
p vehicle roll velocity (radians/sec); p = x, in x 
p general equation parameter in the state space mathematical 
model of an ocean vehicle 
q vehicle pitch velocity (radians/second); q = Xe in x 
q error covariance of the discrete process noise W, 


r vehicle yaw velocity (radians/second); r = x6 in x 


6 error covariance of the discrete measurement noise Ven 


x general ocean vehicle state vector which may or may not 
have the vehicle parameters included within it 
Ur) general Ocean vehicle input vector for state space models 
v measurement noise input vector for state space models; 
Hv (t) vi (t+) ] = R, 6(r) 3 R#R,/6t for diserete noise © 
Ww vehicle input noise vector for state space models; 


EL w(t) «' (t+1) | = Q, 6(7) + Qs Q, 6t for discrete noise 
6(v) Dirac delta function ; (B-7, pages 330-333) 
R discrete measurement noise error covariance; used in 
simulations 
Q discrete process or input noise error covariance; used in 


simulations 


ae 





Pp vehicle parameter or coefficient vector; may be included or 
augmented into x; all coefficients are parameters, but some 


vehicle parameters are not considered to be coefficients 


Zz vehicle output vector for state space models 

t time, seconds 

il system structure vector in state space models 

h measurement structure vector in state space models 
2 parameter structure vector in state space models 


(x,y,Z,8,9,¥) ocean vehicle linear and angular coordinates 
or distances in feet or radians 
(X,Y,Z,K,M,N) ocean vehicle forces and moments (sometimes 
called simply forces) 
(ie ew, D, a,x) ocean vehicle six degrees of freedom in linear 
and angular velocities; see Figure 12.1 
te 


moment of inertia vector or matrix, I. = (I... I. I) «s 
— XX YY 22 
il 


(Mii Te aT. 
X) 7 %X_ Xs 
i=1,6 comma designates intermediate values, i = 1,2,3,4,5,6 

i,j=l,6 means i=1,6 and j = 1,6 

Af the identifiability of a parameter or coefficient 


M the modelability of an ocean vehicle 


dk 
X vehicle forces and moments, X = (X Y Z K M N) 
ig it 
C.G. center of gravity, x, = (x, Ye Zc) = (X ¢ Xo X30) 
C.B. Cent fb ( ? ( Ne 
-B, Center of buoyancy, x, = (xg Yp Zp) = Xp Xop 3p 
m mass of the ocean vehicle (slugs) 
X.. vector of the ij'th force and moment second degree 
coefficients; these coefficients correspond to those 
used in the literature (A-1) (S-9) 


C Scalar cost functional, C > 0 
—-12- 





© 


~> 


p* 
0 


& 


OU 


measurement error 

estimated value of the variable x 

next time increment estimate of the variable x 

time increment 

dependent functions in the identifiability functional I(D) 
system structure; structure in this thesis always refers 
to mathematical equation structure and never to the 
physical structure of a vehicle 

Kalman filter gain matrix 

the optimum or best value of the parameter vector p 
standard deviation of a gaussian random variable | 
symbol meaning "is an element of" 


braces defining a set of numbers 


N(a,b)normally distributed or gaussian random variable of mean 


a and variance b; if a = 0, 6% = b in this notation; also 
written a+o 

equation time constant (seconds) 

in a table indicates a relative minimun as opposed to an 
absolute minimum 

angular frequency of a sine wave, 9 = 2n/period 

gravity forces and moments for an ocean vehicle 

secondary drag forces and moments for the DSRV, Appendix A3 
constant forces and moments for an ocean vehicle 
disturbance (noise) forces and moments for an ocean vehicle 
untransformed DSRV accelerations 


the k*th second degree coefficient in Xs 


oe 





Caamapmthe location of XS in 2 storage vector for computation 


F gradient matrix of an ocean vehicle, F = Qx/Ox 
ato mean + standard deviation of a gaussian random variable, 
WG to) 

LANGUAGE USED 

parameters general variables in the mathematical model 
equations: may be states, constants, or time 
variables 

coefficients ocean vehicle parameters which result from the 
Taylor series expansion of the hydrodynamic 
forces and moments 

noise randon variable, stochastic process, unknown or 
uncertain invut 

and A and B means both A and B 

or A or B means either A or B or both A ae Be 
mneLuSsiVe Ox 

eitherseeor A or B but not both; exclusive or 

neithereeenor means not A and not B 

dynamics the six primary velocities of an ocean vehicle; 
(uvwpgq r)", unless otherwise stated 

moti.on . : . 

behavior " _ 

overall motion z - 

order the highest derivative in a differential equation 

degree. the power of the highest derivative in a differen- 
tial equation or the power to which a term is 
raised in a polynomial 


Eee 





degree of freedom one of the six primary velocities of an 


ocean vehicle 


Chapter P3,2 refers to subsection P3.2 of Chapter P3 
EKF extended Kalman filter 
DSRV Deep Submergence Rescue Vehicle, Figure T2,.1 
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INTRODUCTION (I 
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GENERAL ORIENTATION ‘TO THE PROBLEM AREA 
THESIS PROBLEM DESCRIPTION 

THE OCEAN VEHICLE AS A BLACK BOX 

SYSTEM IDENTIFICATION 


PRIMARY CONTRIBUTIONS OF THIS THESIS 


"TI DO NOT UNDERSTAND; I PAUSE; J EXAMINE,“ ~- MICHEL Diu MONTAIGNE 


(1533-1592) - 


THE PURPOSE OF THIS SECTION IS TO PROVIDE THE READER WITH A GENERAL 


| PERSPECTIVE FROM WHICH TO VIEW THE STUDIES AND RESULTS OF THIS 








THESIS. A VERY GENERAL DISCUSSION OF THE CENTRAL ISSUES INVHSTI-~ 
GATED IS PROVIDED, AND A BRIEF SUMMARY OF SOME OF THE RESULTS AND 
CONTRIBUTIONS IS GIVEN, THIS SECTION ANSWERS THE FOLLOWING 


QUESTIONS : 


WHAT IS THE PROBLEM? 

HOW IS IT SOLVED? 

HOW IS ITS SOLUTION USEFUL? 

WHY IS ITS SOLUTION NECESSARY? 
WHAT MAKES IT DIFFICULT TO SOLVE? 


HOW DOES THE SOLUTION RELAT“ TO THE REAL WORLD? 


THE NEXT SECTION BEGINS THE ACTUAL THESIS STUDIES BY DEVELOPING 


STATE SPACH MATHEMATICAL MODELS FOR THE DYNAMIC MOTIONS OF OCEAN 


VEHICLES. 


= 








CHAPTER Tl 


Coe we Oe ee Oe eo ee 


The studies and results presented in this thesis apply to the 
general areas of motion control and design of ocean vehicles, Both 
the motion control and the design of such vehicles are greatly 
facilitated by the capability of quantitatively predicting the dynamic 
behavior of the vehicle under the influence of its effectors, One 
way of developing this predictive capability is through the use of 
mathematical models and computer simulations which, in essence, run 
a mathematical version of the vehicle in the computer rather than 
running the actual vehicle in water. The computerized version of 
the vehicle allows cheaper, faster, and more flexible studies to be 
made of its motion characteristics than can be made with the full- 
scale vehicle or a physical model of it. However, it is important 
that the mathematical model behavior accurately represent the real 
vehicle behavior in order for the computer simulations to be useful 
in control or design of the real vehicle, 

The studies in this thesis apply to the specific problem of 
determining accurate mathematical models for vehicle motion behavior, 
Such models are determined here by applying the techniques of para- 
metric identification, from Modern Control Theory, to noisy input- 
output data from simulated vehicle maneuvers and to mathematical 
model differential equation structure, from Hydrodynamics, in order 
to evaluate the undetermined portions of the model. These techniques 
may be used both to evaluate the model parameters and to provide 
quantitative and qualitative measures of the mathematical model 


t ae 
e: 25 2s 





accuracy uSing those parameters. 

Tne mathematical model., once determined, may be used by the 
vehicle designer or by the vehicle control system. Such a model 
would be useful in the design process because design changes could 
be reflected directly in terms of the resulting vehicle motion 
characteristics changes. The model would be useful in the vehicle 
control system, within the vehicle during operation or outside of 
the vehicle during the design process, because its predictive capabil- 
ities would permit the control system to select the best vehicle 
effector inputs to carry out a specified maneuver, 

There are many uncertainties involved in the process of develonp- 
ing mathematical models of vehicle BeHEvESY. Whenever vehicle 
inputs or outputs are measured by a data acquisition system, there is 
always some amount of noise present; and whenever the mathematical 
model structure is developed, there is uncertainty as to whether or 
not it will accurately represent the real vehicle. The parametric 
identification techniques used in this thesis are designed to operate 
on noisy input-output data and to give a "best" or "optimum" set of 
parameters in spite of the noise, Therefore, the identification 
methods applied in this thesis will facilitate both the design and 
the control of a vehicle in a noisy environment. 

In the studies of this thesis a mathematically simulated ocean 
vehicle (specifically the DSRV, Deep Submergence Rescue Vehicle) with 
a fixed and known set of parameters is used te gencrate noisy vehicle 
input-output data, The same model structure, but with different or 


unknown parameters, is then used in the identification procedures in 
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attempts to redetermine the original or "true" set of parameters used 
in the data generation, The techniques are developed and utilized 

in such a way that not only are the parameters determined (identified) 
but they are also studied for the characteristics of ease and accuracy 
with which they may be determined (identifiability). 

This combination of identifications and identifiability studies 
of vehicle parameters provides a "bridge" from the simulated vehicle 
to the real vehicle. If the "true" parameters are found again from 
noisy Simulation data, if the real vehicle mathematical model 
differential equation structure is the same as that of the simulated 
vehicle, and if the parameters in the simulated vehicle are identifi-~ 
able from the generated data, then the parameters found from noisy 
real vehicle data should be the “true" parameters for the real vehicle, 
The word "should" is the best that can be used in this logic chain 
because of the model and measurement uncertainties, because of tne 
highly nonlinear nature of most ocean vehicle mathematical model 
structure, and because the proper inputs (sometimes unknown) must be 
used in many cases in order that the parameters be identifiable, 

The specific layout of this thesis proceeds as follows (in brief): 
Section 2(M) present the mathematical model equations, 

Section 3(N) present the equations for the identification techniaues, 


Section 4(P) combine these equations for in-depth studies of simple 
models, 


Section 5(D) present the DSRV 6 degree of freedom model, 


Section 6(C) present selected parameter studies of the large DSRV 
model, 


A diagramatic dependence chain of these thesis sections is shown in 
Figure I1.1 in both number and mnemonic letter form, The general 


layout of the thesis is Set to run from very general ideas in 














Section Mnemonic Letters Section Numbers 


Figure 11.) SECTION RELATIONSHIP DIAGRAMS 


the beginning sections to very specific ideas and evaluations in the 
later sections, The sections have been designed as completely 
independent blocks of ideas with A neateonneeuns peing made through 
equation, figure, and chapter (subsection) references, | 

This chapter has presented a very brief introduction to the 
topics to be covered in this thesis and the order and structure in 
which these topics are tc be discussed, The studies and results in 
this thesis apply to the general area of mathematically simulating 
the overall motion of ocean vehicles, The ultimate aims of mathemati- 
cal simulation are to be able to quantitatively predict the vehicle 
dynamic behavior and to understand the specific features of the 
vehicle which cause it to Benave as it does, This information 
shows the vehicle designer the results of his proposed vehicle 


directly referenced to its motion and allows the control system 


designer to use predictive control methods. The next chapter presents 


AOD 





a somewhat more detailed discussion of the parametric identification 


problem as it applies to this thesis, 





CHAFTER 32 


THESIS PROBLEM DESCRIPLITION 

The problem is to identify certain basic parameters in a mathe- 
matical model wnich simulates the dynamics of an ocean vehicle. To 
identify parameters means to determine their numerical values with 
sufficient accuracy to satisfy a stated criterion. The vehicle model 
to be used is a system of nonlinear first-order differential equations 
with some undetermined parameters or coefficients, 

Tne ocean vehicle mathematical model, hereafter called the model, 
along with its set of identified parameters is designed to directly 
relate to a mathematically simulated vehicle. The simulated ocean 
vehicle, hereafter called the system, is designed to closely resemble 
a real ocean vehicle, A measure of closeness is chosen to specify 
the relationship between the model and the system, and the term 
"optimal" or "best" specifies the desired accuracy of the parameters. 

The computer simulation of the vehicle then consists of solving 
the model differential equations for a given Rs of effector (propel- 
lor, rudder, etc.) inputs and taking input-output data measurements 
from the vehicle motions or maneuvers which result from those inputs, 
The uncertainties in the model structure, the inputs, and the measure- 
ments are Simulated by adding noise, generated by the computer, to 
the model equations ard to the measured data, The parameters used 
in the simulation are a fixed and known set of numbers, 

This noisy data produced by the simulation is then used to 
identify the parameters in the mathematical model assuming that they 
are not known originally. The “best" set of parameters is determined 
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to be those which give the minimum closeness between the simulated 
vehicle and the mathematical model. This process of using the vehicle 
input-output data, mathematical model structure, and measure of 
closeness to determine the parameters in the model is called para- 
metric Meiateveat ion. 

Studies in parametric identification for a particular ocean 
vehicle must first begin with either the assumption or the determina~ 
tion that the parameters are, indeed, identifiable, For given input- 
output data, structure, and measure of closeness, the desired 
parameters may not be identifiable, and the assumption that they are 
identifiable will not be shown fallacious by the failure of a given 
procedure to find them. Identifiability studies are best made = 
using a fixed structure and measure of closeness and then varying 
the input-output data in the identification procedure, 

It is in many cases both easier and less costly, for the purpose 
of studying identification techniques, to make these input-output 
data variations on a mathematically simulated ocean vehicle than on 
a physical model or full-scale os ee wee of the current cape 
abilities of digitel computers. For this reason it is desirable to 
use a simulated vehicle to study identifiability and to determine 
the type of data required for identification, The data from the 
physical modet or full-scale vehicle can then later be used to 
identify parameters in the mathematical model. 

In this thesis the Deep Submergence Rescue Vehicle (DSRV) is the 
particular vehicle studied for the purpose of identifying the param- 
eters in its mathematical model. These parameters are first examined 


to determine their identifiability characteristics, and then they are 
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actually identified using several different kinds of input functions, 
Iwo identification techniques, model reference contouring and 
extended Kalman Filtering, are utilized to identify the parameters 
and to determine their capabilities for identification. A given set 
of DSRV parameters is used to simulate the real DSRV and to generate 
purposely noisy input-output data. Using this input-output data, 
studies ere then made to identify the given set of DSRV parameters 
assuming that they are unknown or inaccurately known, 

Identification of the DSRV parameters by the model reference 
contouring and extended Kalman filtering techniques requires exten- 
sive digital computation. The digital computer programs (FORTRAN IV) 
used for these identifications have been written for a very general 
class of ocean vehicles of which the DSRV is here used as an example. 
Because the computer programs are expected to have more general 
utility than for the DSRV, they are included and 551 ae in this 
thesis. 

This thesis is, in essence, the application of one body of 
knowledge to another, The basic structure of the mathemetical models 
for ocean vehicles is derived from the Theory of Hydrodynamics. The 
techniques for parametric identification of dynamic systems are 
derived from Modern Control Theorye Lengthy derivations in each 
area are referenced, but only the basic eguations to be used in this 
thesis are presented and discussed. 

This chapter nas presented a very general verbal statement of 
the problem to be considered in this thesis, parametric identifica- 


tion for ocean vehicle mathematical models, and the techniques to be 
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used to solve it, model reference contouring and extended Kalman 
filteringe Tne next chapter presents, by way of introduction, a 
verbal view of a general ocean vehicle as a black box (system) with 
inputs and outputs. 

It is possible to approach system identification from either a 
microscopic or a macroscopic viewpoint (G-6), The microscopic 
viewpoint is one of identifying the system by determining the physi- 
cal properties and basic laws of science which describe the behavior 
of the individual parts of the system and combining them, The next 
chapter presents the macroscopic or black box approach which uses 
the system*s input-output information to determine its mathematical 
model. Most of the results of this peesieeam developed using the 
macroscopic approach, and from that standpoint, they are most useful 
in the motion control of ocean vehicles, For the purpose of acquir- 
ing a complete understanding of the vehicle behavior, however, the 


microscopic viewpoint must eventually be used. 





CHAPTER 13 


THe OCEAN VEHICLE AS A BLACK BOX 

For the purposes of simulation, control, and identification 
it is convenient and advantageous to view a general ocean vehicle 
as a black box with inputs and outputs, Simulation then answers the 
question “How does it behave?", control answers the question “How 
do we make it do what we want it to?", and identification answers 
the question "What's inside it?", Control often requires or is 
facilitated by simulation, and both control and simulation require 

| identification in some forn. 

The subject of this thesis is identification, but it is often 
important to know how the identification is to be used in the overall 
system operation, Identification for control may have different 


objectives and accuracy requirements than identification for simula- 


a _ —_— 
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tion, Identification for control mignt be an on-line parametric 

| jdentification to allow the vehicle coritrol system to adapt itself 
to changes in its environment, Identification for simulation might 
require extensive theoretical investigations to determine the model 
structure and then off~line data generation and processing to deter- 
mine parameter identifiability or actual numerical values, 

Ocean vehicles are usually only parts of larger systems which 
have been designed to complete specified missions in order to satisfy 
the goals of societies or individuals. In order to complete these 
missions, the vehicles must be controlled, Control requires knowledge 
of the behavior of the vehicle, and simulation and identification 
provide that knowledge. As the missions which are specified for 


vehicles in the ocean environment. become more complex and sophisticated, 
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the precision with wnicn the vehicle must be designed and controlled 
increases greatly. Very precise control of ocean vehicles often 
requires very accurate mathematical models, multiple degree of 
freedom control and modeling, and control systems which are capable 
of adapting to environmental and vehicular changes, 

An ocean vehicle may be represented by the black box in Figure 
T3501, where the input is designated by the vector u and the output 
by the vector z The sophistication of control systems increases 
in several stages, The simplest control system is the open loop 
system in which the input u is not dependent upon tne output z, but 
is merely a vector function of time. The next step upward in control 
system complexity is the closed loop system in which the input u is 
a function of both time and the output vector z, In both open and 
closed loop configurations the system S may be partially known and 
partially unknown, but in neither case is its form 2 by the 
controller (Figure I3.1). 

An adaptive controller is a major step above the open and 
closed loov controllers in complexity because limited and controllable 
system structural or parametric variations are introduced (H-2). 

The limited system variations are represented in Figure 13,1 by a 
parameter vector p which represents a set of system parameters which 
may be changed by the controller, 

The adaptive controller can in a limited (by the number of elements 
in p) way change both the input u to the system and some of the char~ 
acteristics p of the system, In addition, some or all of the paran- 
eters p may be unknown and require identification by the controller, 


If the parameters are known, they may be treated as additional inputs 
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Figure I3e1 GENERAL SYSTEM AND TYPES OF CONTROLLERS 
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to the system, and the adaptive controller is then in effect a 
closed loop centroller. If the parameters are unknown, the adaptive 
controller must identify them, decide how to vary them to meet the 
goal, and modify the system by actually changing them and by varying 
the inputs. ‘The change in the system is then reflected as a cnange 
or adaptation of the controller, 

The past and present control systems used on ocean vehicles 
include all of these types: open loop, closed loop, and adaptive 
control systems. An example of open loop ship control would be a 
locked helm initially set to a desired course and then held fixed 
for a period of time. The loop could be closed in this control 
system by having a helmsman "feedback" information from the shints 
compass and make helm changes to keep the ship on the desired 
course. In this case the helmsman becomes the closed loop controller, 

Adaptive control has been primarily accomplished in -the past by 
using human beings as the controllers on ocean venicles, For example, 
the captain of a ship usvally develops by experience a mental model 
of the ship's dynamic behavior in ROSE to its inputs, He then 
uses this mental model to decide what bridge commands to issue in 
order to execute a maneuver, such as bringing the ship alongside a 
piers If he has a two-screw ship and loses one propellor due to a 
casualty, he then "adapts" his mental model and control commands to 
execute the maneuver in spite of the casualty. The captain's 
acquisition of experience concerning the mental model of the shiv‘s 
behavior may be likened to the process of identifying parameters in 


the vehicle mathematical model, 
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One of the most important aspects of adaptive control is that 
the model, whether it be a mental model in the captain's mind or a 
mathematical model in an on-board computer, permits the prediction 
of the response of the vehicle to a proposed input function. This 
predictive ecapabaliaty can be used to counteract the inherent tine 
delays in many types of effectors, or it can be used to develop the 
best inputs to the vehicle to accomplish a desired maneuver, 

This type of controller then suggests the idea of an ocean 
vehicle which contains on board a mathematical model of itself and 
the capability of identifying the parameters in that mathematical 
model using the input-output data of the vehicle itself, Any control 
system which employed the predictive capabilities of that a 
cal model could then be made to automatically adapt to changes in the 
parameters of the vehicle and its environment, This forn of control 
system is one of many possible uses to which the identification 
techniques of this thesis and the results of Modern Control Theory 
could be applied, 

This chapter has presented a2 fewer and general look at the 
ocean vehicle as a black box with input u and output z. The types 
of control systems utilized for such systems were described and 
ocean vehicle examples of each type were discussed, Finally, the idea 
of a vehicle containing a model of itself whicn could ve identified 
and used in the vehicle control system was described, The next 
chapter is an introduction to the general process of system identifi- 


cation, 
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CHAPPER I4 


SYSTEM TDEN TIFICATION 

In its most general form system identification is the process 
of properly mathematically modeling the behavior of a given system, 
This means that it is the process of determining a set of variables 
and equations which will describe the performance of the system to 
a specified accuracy. The specified accuracy is usually determined 
by the ultimate purpose for which the system and the mathematical 
model are to be used, 

For the studies in this thesis, system identification can 
quickly be specialized to input-output or macroscopic identification 
of stochastic state-determined dynamic systems (Section M). The 
most general form of this system is the continuous state-determined 
system in equations 14.1 and 14,2 which consists of a set of nonlinear 
first-order vector differential equations and a nonlinear vector 
measurement function. 

Stochastic system identification for the dynamic system in 
equations I4,1 and I4,2 consists of finding f and h given u(t) and 
z(t) in the presence of the unknowns or noises w and v. There are no 
general solutions to this problem nor are there any completely 
genera) techniques which may be used to attack it. Therefore, the 
next step is to assume or to develop from experience or theoretical 
studies the basic form of the two structure vectors f and h with the 
exception of a finite number of unknown or undetermined parameters p. 
This step reduces the system identification problem to a parametri.c 


identification problem for which thexe exist techniques which may be 


Be 
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applied to specific systems, 
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state vector, Chapter M2.1 

Input veetor oMeacentro]l vector 

system noise input vector 

time scalar 

time derivative d/dt 

system differential equation structure vector 
system measurement structure vector 


measurement noise input vector 


System output measurement vector 





Section M in this thesis is designed to show that ocean vehicle 


mathematical models can be placed into the form of equations I4.). 


and 14,2 with f and h known except for @. parameter vector pe Section 


N then presents the equations for the techniques which may be used 


to find the ocean vehicle parameters p from noisy input-output data. 


The mode]. equations and the identification equations are then combined 


for the remainder of the thesis to show specifically how these tech- 


niques work for the DSRV, 
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CHAPTER 15 


PRIMARY CONTRIBUTIONS OF THIS THESTS 

The primary contributions of this thesis are to the area of 
motion control of ocean vehicles. The major contribution to that 
area is the verification that the techniques of model reference 
contouring and extended Kalman filtering are valid and useful for 
identifying parameters in mathematical models with several specific 
ocean vehicle characteristics and equation forms, This chapter 
presents, in a section by section format, those areas which the 
author believes are contributions to and extensions of the — 
theory of motion control of ocean vehicles. 

Section 2(M) presents the rigid body and hydrodynamic equation 
structures for general ocean vehicles, These equations are then 
placed into a state-space form consisting of a single vector nonlinear 
differential equation in the vehicle primary states, The general 
state space equations in Chapter M2, tneir extension to include 
fluidic memory states in Chapter M3, and their extension to include 
higher derivative states of the primary variables in Chapter S2 are 
new and doe not appear in the author's limited sampling of the litera- 
ture in Chapter Bl. 

Section 3(N) presents the detailed equations and procedures for 
model reference contouring and extended Kalman filtering. These 
procedures come directly from the literature of Modern Control Theory 
and do not represent any contribution to the theoretical developments 
of that area, It has been mentioned (A-13) that the area of system 


identification needs specific applications and studies using its 
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available techniques so that better judgements may be made as to 
which techniques to select for a given problem, In this respect 

the application of model reference contouring and extended Kalman 
filtering to the specific DSRV models used in this thesis may provide 
this type of judgement information for someone considering these 

two techniques for his application. The equation simplifications 

in Chapter N3 for the extended Kalman filter when the parameters 

are constants and the modelability and identifiability considerations 
of Chapter N4 may also help in that application. 

Section 4(P) is a detailed parameter study of the DSRV single 
degree of freedom equations using these two techniques. The results 
of the studies of this section show that these techniques work ss 
these equations and give the details of how well they work. This 
knowledge represents a valuable contribution to the process of 
mathenatically modeling the overall dynamic motions of ocean vehicles, 

Section 5(D) presents the DSRV mathematical model, its gradient, 
and a description of the computer programs for calculating their 
numerical values. The DSRV Ras note tical model is taken from the 
literature, but the computer programs were developed specifically 
for the general ocean vehicle models of Section 2(M) with subroutines 
tailored specifically to the DSRV. The author hopes that these 
computer programs will be useful to someone whose ocean vehicle 
model requires them and fits their format. The manner of storing 
and addressing the DSRV second degree coefficients in Chapter Dl and 
the equations in Chapter D4 for use in identifying the A-~matrix param- 


eters are new to these applications. 
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Section 6(C) presents studies of several selected DSRV cocffi- 
ae and pacameters for multiple degree of freedom models to show 
that the parameters may be identified in more complicated ocean 
vehicle models than those of Section 4(P). The highly flexible 
computer programs for accomplishing this are discussed briefly con- 
cerning their structure-selectivity aspects and their utilization for 
general ocean vehicle models, As in Section 4(P) the studies of this 
section show that these techniques are valid for the DSRV mathemati- 
cal model and as such represent some of the major contributions of 
this thesis, 

Section 7(S) is a brief summary of the thesis and a description 
of a large number of areas for further research which may be conducted, 
Section 8(A) is a series of appendices containing numerical values, 
computer programs, and studies by the author of areas related to the 
research in this thesis. Section 9(B) is primarily a bibliography of 
276 references from the areas of Ocean Engineering and Modern Control 
Theory. It is the author's intent that these three sections contain 
information which is ancillary to the main thesis research but useful 
for someone who desires to directly use the results of previous 
sections for his ocean vehicle investigations, 

The purpose of this section has been to introduce the reader 
to the research and organization of this thesis by briefly and very 
generally discussing the areas to be covered. The next section begins 
these research studies by developing stave space mathematical models 


for ocean vehicles, 





SECTION 2 


MATHEMATICAL MODELING OF OCHAN VEHICLE DYNAMICS (M) 

Ml GENERAL OCEAN VEHICLE DYNAMIC EQUATIONS 

M2 STATE SPACE REPRESENTATION FOR OCEAN VEHICLES 

M3 PECULIARITIES OF OCEAN VEHICLE MODELS 


M4 OCEKAN VEHICLE MODELS WITH UNCERTAIN STRUCTURE 


“KNOWLEDGE IS NORE THAN EQUIVALENT TO FORCE," - 


SAMUEL JOHNSON (1709-2784) 


THE CENTRAL PURPOSE OF THIS THESIS IS THE DEVELOPMENT, PRESENTATION, 
DSRV UTILIZATION, AND ANALYSIS OF TECHNIQUES FOR THE IDENTIFICATION 
OF PARAMETERS IN AN OCEAN VEHICLE DYNAMIC MATHEMATICAL MODEL. THIS 
SECTION IS INTENDED TO PROVIDE A COMPLETE MATHEMATICAL MODELING 
FRAMEWORK, OF WHICH THE DSRV IS A SPECIAL CASE, IN ORDER THAT THE 
PARANETRIC IDENTIFICATION TECHNIQUES OF THE NEXT SECTION MAY BE SHOW 
TO APPLY GENERALLY TO SUCH OCEAN VEHICLE DYNAMIC MODELS, LATER 
SECTIONS THEN UTILIZE BOTH THE MODELS OF THIS SECTION AND THE IDENT- 
JFICATION TECHNIQUES OF THE NEXT SECTION TO DETERMINE THE JDENTIFI- 


ABILITY OF SPECIFIC PARAMETERS FOR THE DSRV, 
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CHAPTER 41 


GENERAL OCEAN VEHICLE DYNAMIC EQUATIONS 

This section presents the developnent of the general state 
space equations for mathematically nodeling overall ocean vehicle 
dynamic motions. It begins with a statement and referencing of 
the dynamic equations thus far developed in the literature, and 
then presents the details of their conversion to state space forn. 
The peculiarities of acean vehicle models such as nonlinearities, 
fluidic memory, measurement functions and partially unknown structure 
are then shown to fit the state space format and, therefore,.to fit 
directly into the system identification probiem discussed in Chapter I4, 
The section concludes with a discussion of the procedures to be 
followed in modeling uncertainties in mathematical model structure 
using stochastic processes, 
Mle1 INTRODUCTION TO MODELING OCEAN VEHICLES 

In order to understand the physical behavior of an ocean vehicle, 
man utilizes observations of the vehicle itself, a physical model. of 
the vehicle, or a mathematical model of the vehicle, This under- 
standing of vehicle behavior can then be utilized to help design, 
build, or operate the vehicle to meet its specified mission. Our 
concern here is with mathematical models to simulate overall motion, 
although the vehicle being mathematiceily moceied may be a full-scale 
ocean vehicle or a physical model of it for use in towing tank or 
self-propelled experiments, 

A mathematical model for a dynamic system consists of two parts: 


equation structure and initial conditions, For ocean vehicles the, 
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equation structure for overall motion usually consists of sets of 
differential equations, and the initial conditions represent the 
values of the variables in the differential equations at a beginning, 
specific time of jnterest to the observer, Once the equation struc- 
ture and initial conditions for the dynamic system are known, the 
System can be simulated by solving the equations in some manner for 
a specified input. 

| This chapter presents one form of the basic equation structure 
for a general ocean vehicle and references its derivation in the 
literature. Much of the notation used is either described in the 
Cited references or in Chapter T2, There appears to be two basic 
methods for arriving at these equations: energy methods and vector 
calculus, The energy method uses lagrangian state functions and 
Lagrange's equation and is described by Lamb (L~8), Dogan (B-2), 
and Tufts (T~1) to name only a few. A state space Creanciint of this 
method is given by Schultz and Melsa (S-7), Long (L-5) and many 
others. The vector calculus method consists in essence of a vector 
expansion of Newton's laws of motion and a Taylor series expansion 
of the hydrodynamic forces and moments. This method is derived in 
detail and presented by Abkowitz (A-1) (A-11). The vector calculus 
method wilj. be briefly described in this chapter and its results used 
throughout this thesis because the method leads readily to the appli- 
cation of system identification techni.cues. 

There are two basic types of dynamic equation structure to he 

developed for the mathematical simulation cf an ocean vehicle: the 


rigid body structure and the hydrodynamic structure, The rigid body 
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structure is a collection of terms involving the vehicle mags, 
moments of inertia, velocities, and accelerations combined to satisfy 
Newton's Law. The hydrodynanic structure is a set of terns involv- 
ing variables which express properties of the body of the vehicle, 
properties of its motion, and properties of the fluid through which 
it is moving (A-1). The ocean vehicle dynamic mathematical model 

is then expressed by equation Ml.1 and some statenent of the initial 


conditions of the vehicle at time t,. Both sides of this equation 


Rigid Body Structure = Hydrodynamic Structure 


Vehicle (40) 





represent the forces and moments on the vehicle, 
M1.2 NEWTON'S LAW ~ THE LEFT SIDE OF EQUATION M1.1. 
Tne overall motion of an ocean vehicle when modeled as a rigid 


body motion must satisfy Newton's Law as in equations Ml.2 and Ml.3. 


d_ (Momentum) _ Fo 


d_ (Angular Momentum) . Mo 


uJ A. 
ct 
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The essence of these equations is that the forces and moments 
(Fo, Mo) acting on the vehicle must equal the time rate of change 
of the momentum and the angular momentum in a center-of-egravity 
coordinated system. The fact that the origin of the coordinate 
system is not at the center of gravity (C.G.) and is moving for a 
general ocean vehicle means that these equations must be expanded 


in terms of the vehicle mass, (m), vehicle velocities (uv wpqvr) 
slay 








relative to a coordinate system (x y z QD 9¥V) moving with the vehicle, 
and the vehicle accelerations (iv w pq). 

These equations and the complete details of the expansicn for a 
vehicle of constant mass and time invariant center of gravity location 
are given by Abkowitz (A-1). . The equations for a vehicle with an 
accelerating center of gravity are presented by Tufts (T-1, p. 17). 
The equations for a vehicle with changing mass can be developed by 


using equation Ml.4 referenced to the derivation in reference (A-11, 


pe 36) and by taking into account the fact that the noments and cross 
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products of inertia will also be time varying in equation Ml.3. The 
variable mass, variable C.G. equations could also be fit into the 
identification procedures used in snake thesis. 

The force and moment equations to be examined in this thesis 
with reference to the DSRV are taken from Abkowitz (A-1) for a constant 
mass and constant center of gravity vehicle and listed as equations 


M1.5 - M1.10 for the six vehicle forces and moments (X Y ZK MN). 





Rigid Body Structure 
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For coordinate axes parallel to the principal axes of inertia, 

these equations satisfy Newton's Law for the motion of the vehicle 

as a rigid bedy in space with six degrees of freedom and represent, 
ia may, half of the structure of the mathenatical model differential 
equations, or the left side of equation Ml.1l. 

M1. 3 HYDRODYNAMIC STRUCTURE - THE RIGHT SIDE OF EQUATION M1.1 

The overall motion of an ocean vehicle through a fluid results 
in and from forces and moments functionally related to the properties 
of the vehicle body, the vehicle motion, and the fluid (A-1). ‘The 
hydrodynamic structure has been defined here to represent all of the 
forces and moments acting upon the vehicle with the exception of 
the rigid body or Newton’s Law forces, For the purposes of this 
thesis, the hydrodynamic structure will be broken into the sun of 
three component parts: hydrodynamic forces, gravity forces, and 
effector forces as in equations Ml.]1 and Ml.12. 

It must be emphasized at this point that the reduction of 
equation Ml.1l1 to Ml.12 is a significant one and must be justified 
for the particular ocean vehicle being modeled, This reduction 
says in effect that there is a way to eacewale uncouple the effector 
forces from the hydrodynamic forces, This may be generally expected 
to be true as long as the nee and effector limitations which are 


implied by the uncoupling are determined fer that vehicle, 
Hydrodynamic Structure = f(Body, Motion, Fluid) Pale 


Hyd. Structure = Hyd, Forces + Gravity Forces + Effector Forces 
M1.12 


Where: 


Hydrodynamic Forces = f(Motion) 


Eey 


: 


Gravity Forces = f(Body, Motion, Fluid) 
Effector Forces = f(Body, Motion, Fluid) 

The hydrodynamic forces are those resulting fron the dynamics 
of the vehicle, not including the vehicle effectors, ‘These forces 
are the result of hydrodynamic inertial. efforts which produce "added" 
masses and of skin friction, separation, circulation, and cross- 
flow (secondary) drag effects. The hydrodynamic forces are here 
considered to be functions of the vehicle velocities and accelera= 
tions, but more general formulations can be made and used in the 
identification procedures (see Chapter M3). The fact that these 
forces depend upon a limited and specific nunber of variables means 
that a general structure for the hydrodynamic forces can be developed 
and applied to a large class of ocean vehicles using a Tavlor series 
expansion. 

The effector forces are generally functions which are specific 
to the vehicle under examination and only limited and specific 
structure can be developed, This means that the effectors for a 
given vehicle are best modeled for that vehicle or class of vehicles 
rather tnan by trying to find an all-encompassing system of equations 
which describes a large number of effectors for a large number of 
different vehicles, 

The gravity forces are produced by the creation of a buoyancy 
force B through the center of buoyancy Xp caused by the hydrostatic 
pressure of the fluid, If the fluid properties are constant, the 
vehicle volume and buoyancy are constant, and the vehicle mass is 


constant; then the gravity equations cepend primarily vpon the vehicle 
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orientation, These equations are relatively simple and standard 
and are presented in Chapter D3.2, in references (T-1, p. 21) 
(B-2, pe 27), and are included in the equations of motion in 
reference (B-~9, p. 4.2.1). For the purposes of this thesis the 
gravity terms are included in the effector equations, 

Tne hydrodynamic structure can now be summarized in equations 
M1.13 through M1.18 which represent the right side of equation Ml.l 


and of equations M1.5 through ML.10. At this point the only equation 
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structure really known is the rigid body structure; the functions in 
equations M1.13 through M1.18 are still unknown. The structure of 
the hydrodynamic forces is usually set by expanding these functions 
in a truncated Taylor series. The structure of the effector forces 
is usually determined by theoretical and experimental analysis for 
a particular effector and vehicle. Once the variables have been 
specified in the effector force terms, they can also be expanded in 


a Taylor series, 
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This chapter has presented and referenced the development of | 
the equation structure for mathematically modeling a general ocean 
vehicle, This model structure has been shown to consist of a known 
set of terms which make up the rigid body structure and an undeter- 
mined set of terms which make up the hydrodynamic structure, The 
next chapter develops the state space form for these equations and 
presents the Taylor series expansion equations for the hydrodynamic 


forces and moments, 
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CHAPTER M2 


STATE SPACK REPRESENTATION FOR OCEAN VEHICLES 

state space representations for multivariable, multidimensional 
systems are easier to write down and are easier to compute then 
explicit variable representations. For ocean vehicle dynamic equations 
the state space format is nothing more than calling the primary 
explicit variables by different, ordered, and indexed nanee. Once 
these equations have been placed in the state space form the wealth 
of recent, powerful, organized, and practical results from modern 
control theory can be applied to the understanding of the ocean 
vehicle, ; 

The purposes of this chapter are to provide the background 
necessary to understand what the state of a system means, to present 
the dynamic equations of Chapter Ml in state space form, .and to 
develop the structure of the hyérodynanic forces and Memante by 
Taylor series expansion, The equations and coefficients presented 
here are the general forms to be coupled into the mode}. reference 
and extended Kalman filtering equations presented in Section 3 (N). 
M2el THE STATE OF A DYNAMIC SYSTEM 

The state of a dynamic systen is the minimum set of numbers 
x(t.) Xo(to)s [mes x, (¢,) which, in combination with the input 
to the system u(t) for time t >t, is sufficient to determine the 
behavior of the system for all time t >t. This means that the 
state is the minimum anount of information about the system needed 
to determine its future behavior without reference to its past inputs. 


In essence, the concept of the state of a system divorces the system 
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from its past behavior, In this thesis, as in most of the litere~ 
ture, the states and inputs are represented as column vectors x and 


u as in equation M2z.1. 


x, (t) u, (t) 
Pie) alent) | u(t) = | u(t) N2.1 
x(t) u_(t) 


A dynamic system which can be represented by states and state 
equations is called a state determined dynamic system. The equations 
for representing such systems usually consist cf n first-order 
differential or difference equations, and the form of these equations 
is called the mathematical structure of the system, A non-state- 
determined system would be one which requires an infinite set or 
continuous set of numbers x(n, t) Me specify its behavior at any 
time, Such systems are usually represented by sets of eel 
differential eouations, 

A dynamic system is one which changes state as a function of 
time and is represented by equation M2.2 and diagrammed in Figure M2.1. 
The structure of the dynamic system is expressed by the time deriva- 
tives of the individual states, and a time invariant structvre neans 
that the values of the derivatives in the structure do not depend 
explicitly upon time. Tne essence of equation M2.2 is that knowing 
x at time t means that we can determine x at an infinitesimal tine 
later by adding x(t) + x(t) dt. 

Most ocean vehicle dynamic stxucture is intended to be 


time invariant and so almost all of the equations in this thesis are 
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of time invarient structure, After all, if we have a system of 
differential equations which model a vehicle on one day, ve hope 
that the same equations will be valid the next day. Some examples 
of time varying behavior for a ship might be the growth of barnacles 
on the hull causing the ship's drag to increase with time or the 
wearing out of machinery causing its properties to vary with time, 
In both of these examples the time variance can be eliminated by 
making the parameters which vary into states in the system of equa- 
tions modeling the vehicle. The time invariant form of equation M2.2 


is given by N2.3. 
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Figure M2.1 BLOCK DIAGRAM OF A DYNAMIC SYSTEM 


M2.2 THE STATE OF AN OCEAN VEHICLE 
Given a vehicle underway in the ocean environment, what are 
n numbers x, which, in combination with the inputs u(t) to the vehicle 


for all future time, will completely specify the dynamic behavior of 
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the vehicle for all future time? These n numbers are the sum of 


the Py properties of the body of the vehicle, the n, properties of 


Z 
the vehicle motion, and the fg properties of the fluid (ocean). If 
the fluid properties and the body properties are constant, then the 
motion properties specify the vehicle behavior and are designated 

the states of the system. A partial listing cf motion, fluid, ana 
body properties is given in Chapter T2 and in reference (A-1). 

The properties necessary to specify the state of the DSRV, the 
example vehicle analyzed in this thesis, are the six vehicle veloc- 
ities, three vehicle angles, three location variables for the center 
of gravity, the vehicle weight, the vehicle second-degree coefficients 
(126) and all of the vehicle parameters (587). This makes a total 
of 852 states which specify the dynamic behavior of the DSRV mathe- 
matical model at any point in time. Tne initial value of these 
states, the structure of the equations f, and the input values u(t) 
completely specify the mathematical model for the DSRV and fit 
directly into equation M2.3. For an identification problem all of 
these must be considered states, but for a general simulation the 
C.G., weight, secondedegree coefficients, and vehicle parameters are 
considered to be constant. In that case, the DSRV states reduce to 
the vehicle velocities and angles (uv wpqvxrf9o0vYw), and the state 
vector may be then defined as x = fu, Vigan Fig Dg iGigm 0 g, oe alee The 
DSRV states are described here merely as an example of a few of the 
considerations necessary in defining the states of a vehicles 

For the remainder of this thesis, the vehicle velocities will 
be considered the primary states and will be defined by equation NM2.4, 


The vehicle angles are included in the effector (gravity) functions. 
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This is a somewhat arbitrary and easiiy changed definition as will 
be seen in later sections where tne vehicle coefficients and paran-~ 
eters are “augmented” or "“stackea" into the general state vector x, 
The state vector will generally consist of those variables which 
change as the vehicle mathematical model executes a maneuver, 
M2.3 TAYLOR SERTES EXPANSION OF THE HYDRODYNAMIC FORCES AND MOMENTS 
As mentioned previously, mathematical modeling begins with the 
statenent cr definiticn of state variables and inputs, Tne basic 
Structure of the differential equations for the mathematical model 
is then developed in terms of these variables using theoretical and 
experimental techniques. Chapter Ml discusses the development of the 
rigid body structure for the primary states defined in equation N2.4 
and presented it in equations H1l.5 through M1.10. The next step is 
* determine some form for the hydrodynamic structure in equations 
filets through 41.18. 
it is convenient at this point to define a force vector X as in 
equation M2.5 and to utilize it to write the six structure equations 
as one vector, state space equation Hi2.6, This convention serves to 
simplify the writing of these equations and te simplify their computa- 
tion since they must eventually be calculated using a digital computer 
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X= Xyvg (x x) + Xe¢ (Body, Motion, Flvida) N2.6 





One method of generally specifying the structure of the term 
aed Os, x) in equation N2.6 is by expanding it in a Taylor series 
about some nominal values of the state x. and state derivative - 
and then by some means specify the coefficients or nominally evaluated 
partial derivatives of the terms in the series, It must be emphasized 
that the Taylor series is by no means the only way to begin specifying 
structure at this point. Perhaps a Fourier, Bessel,abs, squae, or other 
series expansion with coefficients to be determined by identification 
could be utilized here, if pe edi or experinental investiga- 
tions for specific vehicles contain any results which will help 
specify the structure of Xnya? they should be used at this point in 
the mathematical modeling process (see also Chapter M3.3). In the 
literature, the structure of X 


—hyd 


series containing the linear terms; see for example Salvesen, et al, 


is often specified by a Taylor 


(S-10), Abkowita (A-1), Mardel (C4), Rees (R-8), and Goclowski(G-8). 
The general form of Xnya to be investigated in detail in later 


sections of this thesis is the Taylor series expansion about x, = ‘s =s 


Q with the retention of only the second-degree terms in x and the 
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linear terms in x. The methods used in the study of the second- 
— coefficients, however, apply generally to other terms in the 
taveor Series or to other coeificients in other types of series 
expansions. The Taylor series expansion of Anya (x, x) for x being 


the vehicle velocities is given by equation M2.7. 
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Tne terms on the right hand side of equation M2.7 which involve 
the derivatives of Aaya evaluated at (x, x) are called the coefficients 
of the hydrodynamic forces and moments, In the mathematical simulation 
of the vehicle, these coefficients are constant ana are designated as 
vehicle parameters, In the identification equations cf later sections, 
however, these coefficients are not constants but become variables and 


are designated as vehicle states, Equation N2.7 represents a conpletely 
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generalized and state space formulated version of equation (75) on 


page 543 in PNA, reference (C-lr), 


_ Without Symmetry _Type of Coefficient _—s_ | With Symmetry 

6 constant 6 

36 linear x 36 
36 linear x 36 
216 second degree x 126 
2.6 second degree & 126 
216 second degree cross product xx 216 
1296 third degree x 336 
1296 third degree x 336 
1296 third degree cross xxx 756 
1296 third degree cross xxx 756 


Table M2.) NUMBERS OF COEFFICIENTS THROUGH THIRD DEGREE 





Many of the coefricients in equation Mé.7 are repeated because of the 
continuity and symmetry of the expansion. For example, let the second 


degree coefficients be defined by equation N2.8 as X, In that case, 
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symmetry requires that X,. = X., and therefore the 216 possible X,. 
“iJ OA “2d 

coefficients reduce to 126 possible wnique coefficients, The numbers 

of unique coefficients including symmetry are aiso listed in Table M2,1l. 


The total mathematical model for the dynamics of a general ocean 


vyehiclé consists of the rigid bees structure of equations Ml.5 throwgh 
«fin 





M1.10 (in state space form), the hydrodynamic structure of equation 
M2.6, and the Taylor series structure for the hydredynamic forces 
and moments in equation M2.7. Tne state space form for the rigid 
body structure in equations M1.5 through 1.10 is given by equations 
M2.9 through M2.14+, In order to place the total mathematical model 
into state space form, the vehicle state derivative x must be either 


explicitly or implicitly solved for in terms of the states x and 


vehicle parameters, 











State Space Form of Rigid Body structure 
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M2.4 SOLVING THE GENERAL EQUATTONS FOR x 

ap orcer to mathematically simulate an ocean vchicle as the 
state determined dynamic system shown in Figure N2,]1, the state 
derivative x must be calculated for each increment of time the 
system runs. This means that the general ocean vehicle equations 
thus far developed either must be manipulated into a form so that 
an explicit solution for x may be calculated or must be solved for 
x implicitly at each time step by finding the solution to a nonlinear 
algebraic expression involving xe | 

The beginning steps in any explicit solution for x are to expand 
the rigid body structure, collect the primed derivatives, and write 
the equations in vector form as in equations M2.15 through NM2.23, 


This then allows the total ocean vehicle mathematical model to be 
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written as equation M2.24%. If the vehicle effector structure Kore 


contains terms involving x, these terms would be included in the left 


hand side of equation M2.24. For a given value of x, the state 


yd ee ED) = r.. (x) + ort 





derivative x is now theoretically calculable by an implicit solution 
of equation M2,24, The calculation of x then permits mathematical 
Simulation of the ocean vehicle dynamic behavior directly as the system 


in Figure M2,1 
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An explicit solution of equation M2.24 is readily arrived at if 
Xnya is represented by the Taylor series of equation M2.7 but with 
only the x terms which are linear in xX retained, In that case equation 
M2.7 reduces to equation M2.25 with the coefficients represented by 
abbreviations of the form of equation M2.8. This series approximation 


generally holds when the values of the state derivative k are assumed 
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M2.25 
to be very small, but the validity of that assumption must be verified 
for the specific vehicle being simulated, The result of substituting 
equation M2.25 into equation M2,24 is given by equation M2.26 with the 


definitions in equations M2.27 through M2.29. Thus, for the cases in 
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which the matrix A is of full rank (det A # 0), the state derivative 


& is explicitly solvable by using the inverse of A, 
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There are several other simplifications which can be made with 


regard to equation M2.26, ‘The equilibrium (0, 0) solution Ms Tor 


most ocean vehicles is X/ = 0. This means that with no inputs they 
are designed to stand eines. and if they are moving and the 
inputs become zero, they eventually stop. If, however, the Xuya 
Taylor series is expanded about a point other than zero (0, 0), 
these constant terms Ky would not be expected to be zero, 

Another simplification to equation M2.26 results from utilizing 
the symmetry of Le to reduce the summations necessary. The total 
mathematical model with Jinear, second, and third degree coefficients 


is then given by equation M2.30. This equation contains 6 states 


and 541 parameters, not counting the effector parameters or structure, 
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The parameters in equation M2,.30 consist of the following: 


7 parameters in A end i My X)q9 Xocs Xac0 I, , I, ; I, 
al 2 3 
36 added mass coefficients x ky 1 =a yR0 
k 
36 linear coefficients X k, iel, 6 


1 
k 
126 second degree coefficients XS k, 1, j= 1, 6, 389m. 


a 
» 


_336_ third degree coefficients X;5. ky, i, j, n=, 6, Syme 


541 total parameters, not including effector parameters. 
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M2.5 EFFECTOR STRUCTURE AND PARAMETERS 

This thesis has thus far jiplicitly considered the effector 
forces and moments to be that part of the hydrodynamic structure 
excluding the hydrodynamic forces and moments, However, for a general 
ocean vehicle, this definition becomes even less precise, and the 
dividing line between effector and hydrodynamic forces is determined 
by the particular vehicle and by which portions of its behavior fit 
into the summations in eauation M2.30 and which don't, 

This is an important point and can perhaps be illustrated by a 
brief reference to the DSRV mathematical model of Section 5 (D). 
The primary DSRV effectors are its movable shroud, thrusters, propellor, 
and tanks. Since each of these directly involves an input variable, 
it is placed in the effector structure, Directly beneath the DSRV 
is a transfer skirt and a splitter plate immediately aft of it. The 
effects of these appendages upon the motion of the vehicle are caicue 
lated using the hydrodynamic coefficients and so these are not 
considered tc be part of the effector structure, The horizontal 
and vertical sidewise (secondary) motions of the DSRV are nodeled 
by a structure (Appendix A3) which does not fit into the coefficient 
summations of equation H2.30. Therefore, for the purposes of modeling 
using equation N2.30, these forces and moments, even thougn they are 
strictly functions of the state x and not functions of the inputs, 
are considered to be effectors, Finally, both structural uncertainty 
(Chapter M4) and input disturbances to the vehicle, such as waves or 
currents, are placed in the effector structure, 

in general, all structure which is functionally dependent upon 


the input variables is considered effector structure, In many cases 
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the effectors on ocean vchicles themselves must be modeled as Gynanmic 
systens with state variables and parameters, It may also be that for 
@ particular vehicle, the effector states or the vehicle inputs cannot 
be uncoupled from the hydrodynamic forces and moments, In this case 
amore general relationship than equation M2,30 would be required 

with structure specifying aun coupling included in the equation, 

As mentioned in Chapter Hl.3, the effector structure must be 
developed for the specific vehicle or class of vehicles, For the 
purposes of the investigations of this thesis, the effector structure 
will be assumed to be known with the exception of a finite number of 
parameters pe The effector forces and monents will also be assumed 
to be time invariant and to depend upon the state x, the input vector 


u, and the general parameter vector p as in equation M2.31. 


Keep @ Lope (Xe Be BD M2. 31 


If the effectors are dynamic systems and nave their own state 
variables and parameters, they should, if possible, be modeled as 
separate subsystens with only their input-output relationship apparent 
in MZ2.31. The fact that for a particular vehicie the effectors are 
dynamic systems does not necessarily mean that the identification of 
their parameters in p is impossible or even that its identification 
is more difficult than that for a vehicle with static system effectors, 
M2.6 SUMMARY OF THIS CHAPTER 

It is a fascinating question to ask oneself what single eauvation 
can be written which will model the states of anything which noves! 
(Equation M2.2) We then ask ourselves how this equation changes when 


we restrict ourselves to a vehicle rnhich moves under Newton's Law, 
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(Equation M2.15) At that point we enter the ocean environment and 
begin to develop a further reduced state equation. (Equation H2.30) 
If we now take the 54] parameters of equation N2.30 and include then 
in the general parameter vector p, we can write a final state space 


equation which will model a large class of ocean vehicles, (Equation 


M2. 32) 





h (p) x = f (x, p) az Lore (x, Uy p) M2. 32 
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: The next chapter is a more extensive discussion of several of 

| the peculiarities of ocean vehicle behavior which in some cases » 
cannot be modeled directly by equation H2.30. The concept and form of 
a measurenent function for the states of an ocean vehicle is presented 
and discussed. The fact that fluidic memory does not directly fit 
equation M2Z2.30 is discussed, and a more detailed Foimilacien of 
several types of nonlinear behavior is analyzed and the inclusion of 


such behavior in the model structure is: considered. 
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CHAPTER M3 


PECULIARITIES OF OCEAN VEHICLE MODELS 

There are some dynamic system peculiarities exhibited by ocean 
vehicles which cannot be modeled directly by equation M2.30 or which 
require further comment regarding their inclusion into the general 
model. Several of the topics to be covered in this chapter are the 
measurement function, fluidic memory modeling, and nonlinear behavior, 
This chapter is not essential to the identification studies of later 
sections of this thesis but is incivded as an extension to the theory 
of modeling a general ocean vehicle, 
M3.). MEASUREMENT FUNCTIONS 

For the purposes of the identification studies in this thesis, 
the deterministic measurement function (Chapter. I4) for the general 


ocean vehicie has been assumed to be given by equation M3.1. ‘This 
a x M3.1 


assumption is not valid for most measurement systems used on such 
vehicles. The neasurenent function is a transformation relationship 
which expresses the system output quantities 4 in terms of the 
observable or measurable states x of the dynamic system and is usually 
a nonlinear function for ocean vehicle measurenents. 

Equation M3.]1 is from a simulation and identification standpoint 
the simplest measurement function which could be used. If the states 
of an ocean vehicle were measured by Jinear sensors and amplifiers, 
the relationship would be as in equation M3.2, where the H natrix 


represents the cross coupling of the states and the amplifier gains. 


-~-69- 





Tnis type of measurement function fits directly into tne existing 


state space theory for dynamic systems (S-7) (S-3) (D-4) (A-6) (H-4) 
(B-7) (0-1), etc.; and assuming that the states are "observable" 
(see references), equation M3.2 is easily incorporated into the 
general model and into the identification procedures of later sec- 
tions. There have also been procedures developed for linear systems 
which are not observable (D-1). 

The general class of sensors and measurement systems used for 
ocean vehicles contains many different types of devices (pressure, 
velocity, and inertial sensors, doppler sensors, meters, computers, 
etc.) and, therefore, will be modeled by many differently structured 
measurement functions, Tne form of the measurement function for a 


general nonlinear systen is given by equation 3.3. With this form 
z= h (x) N3.3 


for the measurement function, the first consideration with regard to 
any total mathematical model or to any system identification must be 
to test the system for observability. Such tests are developed or 
referenced in the literature (G-9) (S~5), but these methods become 
prohibitively tedious for significant nonlinearities or for muitiple 
degrees of freedom. A possible, but perhaps expensive and time 
consuming, alternative to this test is to essume observability and 
proceed to the identifiability studies of later sections, If trouble 
is encountered there, this assumption, along with many others, would 


have to be questioned, 
Livi 
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The form of equation M3.3 used in the general parametric ident~ 
ification probiem is given by equation H3.4 in which the structure 
h is assumed known and the parameter vector p is te be determined by 


identification. The nonlinear observability criteria must also be 
zZoh nup) M304 


analyzed for this equation - with the previous equations, 
The next step upward in generality of measucement functions 
would be one which was dependent upon the input ue. This equation 
is given by M3.5 and would be required whenever the measured variables 


could net be uncoupled from the vehicle inputs. Equation M3.5, as with 
z.=h (x, wu, 7) 3.5 


previous equations of this chapter, is a static relationship. If 
the effectors for a given vehicle are dynamic, having their own state 
Variables; then if possible, only the input-output relationship 
should feed into equation M3. 5. 
M322 FLUIDIC MEMORY 

The essence of fluidic memory is that the future behavior of a 
vehicle in a fluid depends not only upon its present motions, but also 
upon all past motions, This in fact says that the general ocean 
vehicle is not a state-determined system (Chapter M2.1) and that 


equation MN2.5 is incomplete and should be modified as in equation H3.6. 


Body, Motion, 


X= Anya (Motion, Past Motion) + Kore ( 


Past Motion, Fluid) M3.6 
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The fact that vehicles moving in fluids have beer shown to depend 
upon their past motion is pointed out and referenced by Newnan (N-5) 
(N-6) and Dogan (D-2). The models which must be used for inclusion 
of all past motion in the general ocean vehicle simulation would have 
to consist of partial differential equations representing the distri- 
buted or infitite-state time behavior, It is expected that for the 
general case, these equations would be extremely difficult to solve, 

One method of having the gencral vehicle mathematical nodel 
take into account the past vehicle behavior is to increase the number 
of states x to include the present state and the past states at n 
inerenents of time into the past, This representation implicitly 
assumes that the fluidic memory is finite in length of time and that 
it can be modeled by n time-samples inte the past (Xo x. , ee, x )e 
This assumption then allows the general ocean vehicle with fluidic 
memory to be modeled as a state determined system with n + 1 times 
as many states as the model without fluidic memory. 

The modifications which must be Fade A6 equation M2.2% to include 
the finite memory are conceptually straightforward even though perhaps 
computationally prohibitive, The first step is to define a new state 
vector Xoo to include all of the present and past states as in equation 


M3.7.- In this equation the variable x is actually x(t), where % is the 


x(t) 
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present time of consideration, and is the same as equation M2.4, 
The "nemory" variables are then spaced at increments of time into the 
past (3, ren 6) and the variables are the vehicle velocities 
evaluated at those times [x (t-6,), eee, x (t - 6) ]. 

The matrix A and vector. f.. (x) in equation 2.24 are independent 
of the menory effects and are thus merely repeated and evaluated at 
the past times to form the matrix Ken and vector Lom given in equa~ 


tions M3.8 and M3.9. Tne terms 2 and X ee represent the coupling 


-A = Ke M3,8 


faee Bie. (x , M309 


of the past states into the present as well as representing the 
present behavior of the vehicle, These new functions ere designated 


here as Xen, hyd (x-0 Xen) and Xen, eff (Xp. Wea p)e If the effector 


parameters p were time varying, then a fluidic memory version Pon 


would have to be included in X .rne The combination of these 
—fm, eff 


results permits the total mathematical model including fluidic memory 


to be written as equation M3.10. 
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fn “fn ~ “fm, hyd (x5 im! Xe.) = Joey (6 nm + Len, eff (X- » Year B) 
M3.10 
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The same considerations now apply to equation M3.10 as previously 
plied to equation 12.24 except some of the very beneficial symmetry 
reductions in the latter equation cannot be applied to the Taylor 
series expansion of the former, The finite fluidic memory version of 
equation M2.30 without taking into account any possible symmetry is 
given here as equation M3.11. The fluidic memory A matrix is defined 
the same as in equations M2.27 through M2.29 except that the indices 
meas i, j = l, 6.(n +1), and the a 


The swnmations run over all of the finite memory states, and the number 


terms are differentiated, 


of these is given by equation M3.12. The fluidic memory A matrix is 


square and of dimension n * yy 
i fm fm° 
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fn” 6 {(n + 1) where n= number of past times 
in memory 


M3. 12 


Solving equation M3.11 fer many past times is prohibitive from 
a computation-time standpoint, However, it is felt that the complex- 
ity of equation M3.11 can be very significantly reduced by incorpor-~ 
ating the specific characteristics of a given ocean vehicle pa eliminate 
a large percentage of the terms and coefficients and still successfully 


model the vehicle including memory effects. The point to be made here 


is that fluidic memory seldom need apply to all past times in all past 
27s. 








degrees of freedom but in general is only significant in one or two 
degrees of freedorn. The study of these limitations and the utiliza- 
tion of equation M3.11 represent extremely profitable potential areas 
for breakthroughs in ocean vehicle mathematical modeling. These 
vehicle initetions conbined with symmetry reductions would reduce 
equation M3.11 to a computationally solvable system which could then 
be utilized in the identification equations and methods of later 
sections of this thesis. 
M3-3 NONLINEAR BEHAVIOR 

There are several instances in which the structure of equations 
M2.30 and N3.1]1 may need to be modified to take into account some 
very obvious nonlinearities in ocean vehicle behavior, Several of 
the considerations necessary to nake these modifications are given 
by Abkowitz (A-11) (A-1) and Mandel, (C-4, p. 544). The modifications 
are described and illustrated in the below examples, but the basic 
aim of structural modifications is to minimize the nunber of coeffi- 
clients or parameters which must be ee iietod. The equation structure 
is by far the most important part of the mathematical model; and if 
variations in the basic Taylor series form gives closer data fit with 
fewer parameters, then the structure should be modified to include 
those variations. 

As a first example let us consider the hydrodynamic drag force X 
exerted upon an object being pulled through a fluid with a constant 
velocity u. Suppose that a drag coefficient i can then be cefined 


q 


for the object as in equation M3.13. If 2 ae has been shown to be 


X= X, u? 13.13 
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constant ror the given object, then Xu corresponds perfectly to 04 
in equation MZ. 306 Now consider that the same object js being pulled 
in the opposite direction with gs constant velocity u, where u is 
negative. In this case equation M3.13 is no Jonger structurally 
valid because we know that a negative force must be required, 

There are at least three possible ways to remedy this mathemat~ 
ical structure discrepancy: a larger number of faylor series terns, 
foreward and reverse values for Xu? or adoption of an absolute 
square law structure. The objective here is to have ea structure 
which corresponds as closely as possible to tne behavior of the 
object, but it is also desirable to have the smallest number of 
perameters if these parameters are to be identified using the pro- 
cedures of this thesis. If we plot the tehavior of the object, we 


get the curve given in Figure H3.1. 























Figure M3.1 ABSOLUTE SQUARE LAW DRAG 
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Given a desired measure of accuracy which the model structure 
must have in order to be said to represent the behavior of the object, 
then certainly if enough odd degree terms in the Taylor series are 
utilized, the behavior of the object can be modeled, This structure, 
however accurate, must contain more parameters than simply en and 
would therefore be a much more costly model in terms of later effort 
in identifying those parameters, AJl of this is, of course, for the 
case in which the above data plot is considered to be structurally 
Proper, but nunerically inaccurate, or in other words, is noisy. 

Another way to take care of the reverse bshavior in Figure N3.1 
is to simply state that he has one value for the foreward mode 
(nanely X and another value for the reverse mode (namely PEC ie 
This in effect gives two separate mathematical models for two separate 
regions of the object and requires two parameters for the complete 
model, There are several aifficulties encountered with this repre- 
sentation used in the parametric identification procedures of later 
sections. First of all the regions of operation must be strictly 
observed for the specific model used, Secondly there are twice as 
many parameters to identify. Finally, wnen Kalman filtering is used 
and Xu is considered a state variable, it must be modeled as a highly 
discontinuous function. 

The best way to model the object behavior in Figure M3.1 is by 
recognizing that the basic curve shape is absolute square, ‘This then 
permits the model to be written as equations M3.14 and M3.15 and 
requires only one parameter, This term would then replace the Gy 
term in the Taylor series model of equation M2.30, and its inciusion 


there vould most likely contribute to the overall model parameter 
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jdentifiability from noisy data. 
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Another specific instance in which structure has been developed 
which does not fit into equation MN2.30 is with regard to the secondary 
or cross flow drag equations for the DSRV (Appendix A3). ‘These 
equations are appended as effector functions and the corresponding 
terms in the Taylor series are deleted because the analysis of pre- 
liminary experimental and theoretical data resulted in a structure 
which did not fit directly into the series, 

It is hoped that these examples may serve to point out the 
importance of proper model structure in later parameter identifiability 
Studies and identifications, The lesson to be learned is that when- 
ever a choice must be made between Taylor series terms and a different 
structural form resulting from preliminary investigations, the latter 
should always be included in the medel, 

This chapter has presented some extension and modification 
ideas which in some cases must be applied to the general mathematical 
mocdeis of Chapter M3 in order to properly simulate the vehicle or in 
order to ve able to identifv parameters using the techniques of this 
thesis. The first of these was the concept of a general nonlinear 
measurement function whose structure must be determined for a specific 
vehicle and whose parameters may need to be identified. Next the 
general ocean vehicle mathematical model was modified to include the 


effects of fluidic memory by assuming that the memory was finite and 


9 





that it could be represented by n past sanples of the vehicle states, 
Finally, the general modet was also modified to include significant 
structural nonlinearities which were not consistent with the Taylor 
series representation. The next chapter presents the modifications 
to the total mathematical model necessary to include the effects of 
uncertain structure, both in the basic vehicle equation and in the 


measurenent function. 





CHAPTER M4 


OCEAN VEHICLE MODELS WITH UNCERTAIN STRUCTURE 

The primary purpose of this chapter is to include in the general 
ocean vehicle dynamic mathematical model the fact that at this time 
neither theoretical nor experimental analysis can completely or per- 
fectly determine the structure of the vehicle equations or of the 
measurement function. This fact introduces into the ponerall model 
tuo forms of “uncertainty” or noises process noise w and measurement 
noise v. In both cases these uncertainties are modeled as stochastic 
precesses (P-3) (S-S) (A~-5) (B~8) (B-7) (C~3) (J-6) (L-6) (M-2) (R-4) 
(S=-3) etc., and then these terms are included as random variables in 
the mathematical model used for simulating the real vehicle, The 
deterministic version (without w and v) is used as the model to be 
varied in the identification anoeseince of later sections, and the 
Stochastic version (with w and v) is used in the sea trial data, 
generation or real vehicle simulation. 

The total ocean vehicle mathematical model may be summarized 


here by repeating eauations M2.32 and M3.5 as equations MY.1 and M4.2. 
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Ocean Vehicle Dynamic Mathematical Model 
A(p) x =e i, (copper (x, wy DP) Mel 


=h (x u p) MA. 2 
This set of equations is a deterministic system of differential 
equations which contains in some sense al] that is known about the 


dynamic benavior of ai ocean vehicle. If, at this point, it is 
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desirable to also model the unknown aspects of the vehicle behavior 
by two stochastic processes w and y, then the mode] becomes non- 


deterministic and is represented by equations M4.3 and M4.4, If 







Ocean Vehicle Stochastic Mathematical Model 


A(p) x= f (x. P) + Bopp (Xs We Be ¥) | ME. 3 


zZ=h (x, Us Ps v) Mp, 4 
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the very strong assumption is then made that these noise processes 
are coupled linearly into the dynamics of the vehicle, then the 
equations M4.5 and M4.6 result. ‘The validity of this assumption 
would have to be determined for any ocean vehicle under considera- 
tion by theoretical, experimental or identification studies, 


¢ 


Ocean Vehicle Stochastic Model With Linear Noises 


A(p) x = f (x5 p) + Lore ee Us, p) + G Lik M4.5 


Zeyh (x, we p) + Y. 14.6 


In both cases the noise vectors w and v may be considered to be 
models for structural uncertainty or models for input function 
uncertainty. In equation M4,5 the noise vector w may represent a 
stochastic model cof the remaining terms in the Taylor series expan- 
sion of £ which were not included, or it may represent a medel for 


the unknown aspects of the effector function Lore structure. in 
an i 
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addition w may model unknown aspects of the input vector u (K-6, 
p. 166) or noise in the measurement system for determining u for the 
vehicle. Likewise, oy mode] the structural uncertainty of h or 
the noise in the input vector ue. In both cases the noise inputs 
change the equations from a time invariant to a time varying system, 

For the purposes of the identification studies in this thesis, 
the noise vectors w, and ve will be assumed to be uncorrelated, discrete, 
zero-mean, gaussian white noise processes described by equations M4.7 
through M4.10. This is done in some instances to simplify the tech- 


niques and in other instances to simplify the computations, Furtner 


®= Ew jl=v= ev j=0+ 


M4. 7 


{= 
os 

t 
4s! 


EL w(t) wi(t+7) ] 


i 
> 
om 

pats 
a 

A 
& 
22 


Q,6t for discrete uw, v4.8 


Bf v(t) vi(t4+9] 


i 
ae 
om 
CoN 
eal 
~~ 
28 
22 


R/ ot for discrete v, M49 
Huy] = [0] Hl. 10 


studies can now be made using the techniques of this thesis and 
relaxing these assumptions through procedures in the literature to 
determine structure and identifiability for specific ocean vehicles. 
As previously mentioned, the measurement function to be used in 
Bene analysis in this thesis is an identity between states and measure- 
ments plus linear noise. In addition, the process noise coupling 
matrix G is assumed to be the identity matrix, These two assumptions 
result in the model given by equations M4,11 and M4,12 and the system 
diagram given in Figure M4.1. Future studies should be made on the 


general vehicle model without these two assumptions to determine 
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their effect upon identifiability of parameters using the techniques 


of this thesis. 







Specialized Ocean Vehicle Stochastic Model 
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Figure M4.1 SYSTEM DIAGRAM OF A GENERAL OCEAN VEHICLE 
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~ MATHEMATICAL MODEL WI WITH ‘TH NOISE INP! INPUTS 


This chapter has presented the hierarchy of models which result 
from the inclusion of stochastic processes w and v to model structural 


uncertainty or input noise. These stochastic models are to be used 


#32. 





in this thesis for simulating the real ocean vehicle in a “noisy" 
environment. ‘Their deterministic versions with variable pavtaneters 
will then be used to process the data and identify the parameters, 

This section has presented or referenced the complete develop- 
ment of general mathematical models for the dynamic behavior of ocean 
vehicles, These models have been presented in a hierarchial manner 
starting with the most general versions and then proceeding to the 
simpler versions by naking assumptions with regard to the vehicle 
behavior, The models have been developed using a state space format 
to simplify writing them down and to simplify their computation, 
Several extensions to the general models in the form of measurement 

‘ 

functions, fluidic memory, nonlinearities, and uncertain structure 
have been discussed and their equations presented. The next section 
presents the identification equations wnich are to be applied to these 
models and the simulated noisy data to evaluate the oe pareneter 


vector p and to determine its identifiability. 
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SECTION %3 


PARAMETRIC IDENTIFICATION OF NONLINEAR STOCHASTIC SYSTEMS (N) 
NL DEFINITION OF PARAMETRIC IDENTIFICATION 

N2 MODEL REFERENCE IDENTIFICATION 

N3 EXTENDED KALMAN FILTERING 


N4 STUDYING IDENTIFIABILITY OF PARAMETERS 


PERHAPS CONCERNING IDENTIFICATION: 
“= = ON A HIGH HILL 
RAGCED AND STEEP, TRUTH DVELLS, AND HE THAT WILL 
REACH HER, ABOUT MUST, AND ABOUT MUST GO; 
AND WHAT TH® HILL'S SUDDENNESS RESISTS, WIN SO." 


JOHN DONNE, SATIRE III OF RELIGION 
(1.590) 


THIS THES{S IS PRIMARILY CONCERNED WITH APPLYING MODEL REFERENCE AND 
EXTENDED KALMAN FILTERING IDENTIFICATION TECHNIQUES TO DYNAMIC 
MATHEMATICAL MODELS OF OCEAN VEHICLE MOTIONS, WITH THE DSRV 4S AN 
EXAMPLE. THE LAST SECTION DEVELOPED GENERAL STATE SPACE CCRHAN VEHICLE 
MODELS AND EXPLAINED THEIR LIMITATIONS AND POSSIBLE EXTENSIONS. THIS 
SECTION PRESENTS THE BASIC EQUATIONS FOR THE TWO IDENTIFICATION 
TECHNIQUES AND EXPLAINS HOW THEY ARE USED, THE NEXT SECTION THEN 
COMBINES THE GENERAL MODEL EQUATIONS AND THE IDENTIFICATION EQUATIONS 
AND SHOWS IN DEPTH HOW THEY APPLY TO SEVERAL SIMPLE EXAMPLE DSRV 


EQUATIONS, 
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CHAPTER NL 


ME ce NS i EE SS ee ee Rm 


The purpose of this section is to present and discuss the equa~ 
tions for the general problem of identifying parameters in a nonlinear 
dynamic system using model reference and extended Kalman filtering 
techniques. To begin with, this chapter defines parametric identif- 
4cation for general and for more specialized cases and cites sone of 
the literature applicable to these problems, The next two chapters 
then describe the two techniques to be utilized in this thesis to 
study the DSRV coefficients and parameters: model reference contouring 
and extended Kalman filtering. Finally, the last chapter presents a 
general discussion of the considerations and steps involved in 
determining quantitatively whether or not a given parameter is 
jdentifiable for a given vehicle and given type of maneuver, 

Nl.e1 INTRODUCTION TO PARAMBZTRIC IDENTIFICATION 

In Section 2 (M) the process of understanding the dynamic behavior 
of ocean vehicles using mathematical modeling was discussed, In this 
section the details of a group of techniques for determining certain 
unknown portions of those mathematical models from either full-scale 
or phySical model data are presented, These techniques operate on 
mathematical models which are known except for the n ~ constants in 
a parameter vector p and on noisy data from a real vehicle or a 
Simulated vehicle. The goal is then to determine a proper value of 
p and thereby complete the specification of the nathematical model, 

The theory of parametric identification is by no means the only 


way to attack this problem. The history and Jiterature of ocean 
LOGE 
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engineering are replete with valuable, practical, and proven tech- 
niques for modeling ocean vehicle dynamic motions, This thesis is 
proposing another set of techniques; however, this set of techniques 
is shown to be applicable to completely general, nonlinear, six- 
degree~of-freedom, noisy mathematical models with lerge nunbers of 
undetermined parameters, ‘These techniques have been proven extremely 
valuable and workable in aircraft, spacecreft, electrical and mech- 
anical systems, economic systems, chemical processing systems, social 
systems, and many others. The combination of the present and past 
techniques from ocean engineering with the present and past techniques 
from modern control theory offers substantial breakthrougns=-~-theoretical, 
experimental, and practical--in the area of ocean vehicie mathematical 
modelins. 
N1.2 THE GENERAL PARAMETRIC IDENTIFICATION PROBLEM 

Parametric identification is the determination of a set of 
parameters or coefficients of a dynamic system mathematical model of 
known structure using measurements of the actual systen's dynamic 
behavior with the ultimate aim of having the model be the mathematical 
equivalent of the system. ‘Tnis chapter describes the general parametric 
identification problem for a nonlinear, state-determined dynamic system 
with noise and then specializes this problem to the point at which it 
can be shown to include the models of Section 2 (M). 

The general nonlineer stochastic parametric identification 
problem is defined by equations Nl.1, N1L.2, and N1.3 in Figure Nl,.1. 
A block diagran of the dynamic system equations Nl.1 and N1.2 is shown 
in Figure N1.2 (G-6) (C-2) (S=-3) (1-6) (S-6) ete. This parametric 


identification probiem has no completely general solution. Any 
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Givens: 
State Equation 
4 P fe 
m= £ (ay ub eH, N11 


Where: 


ad 
if 


state vector (n * 1): x (i) known 


iS 
tt 


= control vector (m * 1); u (t) known 


icv 
i! 


parameter vector (n,, *1)s p= & (yp). p (¢,) known 


2 process noise vector (r * 1) 


I= 
Nd 


Jct 
qu 


time scalars t known 


IH 
tj 


systen structure vector (n * 1); known 
Measurement Equation 
z= h (xX Us Ps Ye ¢) NL.2 
Where: 
z% = measurement vector (k * 1); 2 (+) know 
Vv = measurement noise vector (j * 1) 


h = measurement structure vector (k * 1); known 
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Cost Functional 


C=C (2, z.,) CaO N1.3 

ghee: 

C = scalar cost functional representing a measure of 
closeness between the system output & and the mathe» 
matical model outrut Zi known structure; C > 0 

4- 


Using: 

Wt yt) Loree x(t) p(t), tor C 
Finds 

p (t) to minimize C (or to maximize -C) 


Figwre Nl.1 THE GENERAL PARAMBURIC IDENTIFICATION PROBLEM 
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solution techniques to be applied to problems of this nature must 
in general be tailored to the positive semidefinite cost functional 
and to the specific types of structural nonlinearities, In many 
cases the properties of the specific nonlinear system must be used to 
reduce the complexity or generality of equations Nl.1, N1.2, and N13 
to facilitate identification, 
N13 THE OCFAN VEHICLE PARAMETRIC IDENTIFICATION PROBLEM 

The specialized ocean vehicle stochastic model which was pre- 
sented as equations M4,11 and M4,12 in Section 2 (M) can be seen to 
be a sub-case of equations Nl.1 and N1.2 in this chapter, The 
assumptions which must be made on equations Nl.1, Nl.2, and N1.3 to 


reduce them in generality to the level of equations M4.1] and MU.12 






Figure Nl.2 PARAMETRIC STOCHASTIC DYNAMIC SYSTEM BLOCK DIAGRAM 
with a weighted quadratic cost functicnal are listed below. The weighted 
quadratic cost functional is designed to be a general distance measure 


between the model zZ. and the system 2 for a given maneuver and set of 
a; 2 
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Model structure and measurement structure are time invariant, 





2. Mode). and measurement noises are linear and enter the systen 
directly. 

3. The structure of the. measurement function h is simply the 
vehicle states x with linear measurement noise. 

4, The cost functional is a weighted integral of the square of 


the difference between the model and the systen, 





The parameters are not states but are constants to be evaluated, 


model parameters. These assumptions reduce the general parametric 








identification problem of Figures Nl.1 and N1l.2 to the ocean vehicle 
parametric identification problem of Figure Nl.3 and Figure M4.1. 
It is this latter problem with only the second degree coefficients 
and with the DSRV values and effectors which will be investigated in 
detail in Section 4 (P) and 6 (C) of this thesis, 

Much of the applicable literature (see Chapter Bl) is devoted to 
the linear state estimation problem (Chapter N3) which results when 
the parameter vector p in Figure N1.3 is “augmented" or “stacked" into 
the general state vector x. A great ony results are available with 
regard to the solution of the linear state estimation problem (A-2) 
(A-6) (A-8) (B-5) (B-8) (D-1) (D=4) (E-1) (F+2) (H-3) (J-1 to 5) 
(M-4) (M-5) (N-1) (R=5) (R-7) (S-3) (S~6) (S-7) (1-2) etc., but 
these results do not in general apply to the nonlinear models which 
must be used for ocean vehicle behavior. Instead, they give a very 
specialized and often incomplete mene of the actuai nonlinear 


behavior involved, 
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State Equation 
x= f (x, a p) +e N14 
‘Where: 
aCp) Lf (x P) + fore (x vw b)] 


in equation M4,11 
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equation M4.11 


Z=2ex+tv N1.5 


Cost Functional 


t T #L 
c= f Ei(g=2) R (2-2) dat N1.6 
Sos Ma ae n ‘= =m 
Cr=sou, ep): CSO R, = Weighting Matrix 
Using: 
u (t), z (t), f, x (to) p(t), oe C 
Finds 


p to ninimize C 


Figure Nl.e3 THE OCEAN VEHICLE PARAMETRIC IDENTIFICATION PROBJ-EM 
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As mentioned previously, there are no general methods with which 
to solve nonlinear stochastic parametric identification problems. The 
best that can usually be done is to take a proven method for linear 
Systems and extend it in some manner to cover the specific nonlincar 
system of interest. If the extension can then be shown to be valid in 
Some manner, then it can indeed be useful for that specific nonlinear 


system. 
y i Jone 








Tnis chapter has presented both a general and a more specific 
definition of the problem of identifying parameters in a nonlinear 
stochastic dynamic system. The assumptions leading from the general 
to the specific versions have been presented, and the ocean vehicle 
stochastic model of Chapter M4 has been shown to be equivalent to the 
specific model equations N1.4 and N1.5. The next chapter presents 
one solution technique, namely model reference contouring, which is 
applicable to the ocean vehicle parametric identification problem of 


Figure N1,3. 
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CHAPTER N2 


MODEL REFERENCE IDENTIFICATION 

The problem of finding a set of numbers or parameters p ina 
mathematical medel in such a way that the same input u to the systen 
and to the mathematical model produces the same output 2 from both 
has been defined in Chapter Nl] as parametric identification. This 
chapter describes what mignt be considered the most “obvious" or the 
“brute force" method for attacking this very general problem, model 
reference identification. As a general procedure, model reference 
identification runs the model, with the same inputs as to the systen, 
for a large number of different parameter vectors p and then selects 
the specific p which results in the model output Z which is "closest" 
to the original system output z This technique is described here by 
first listing its detailed computational steps, then by discussing 
the problems and possible variations of each, and finally by describing 
cost function contouring, the specific variation to be used in this 
thesis. 

It is not intended that an extensive presentation of model 
reference identification be given in this chapter, This chapter 
presents, as a background, the specific configuration and computation 
steps necessury to understand the general utilization of the method 
and the specific computations and studies employed in this thesis. 

The literature (Chapter Bl) abounds with other variations of the model 
reference approach to parametric identification, many of which offer 


promise for application to ocean vehicle studies. 
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N2.1 MODEL REFERENCE CONFIGURATION 

ie basic configucation for the model reference identification 
technique is shown in Figure N2.1. In this configuration the SYSTEM 
may be the input-output data from one of the following: a noisy 
full-scale sea trial, a noisy scale-model towing tank or self- 
propelled test, or, as in this thesis, a simulated ocean vehicle using 
Figure M4.1 and equations Nl.4 and N1e5 with a fixed set of parameters 


pe The most general version of the SYSTEM is given by equations N1.1l 


and Nl.e2 and Figure N1.2. 
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Figure N2.1 MODEL REFERENCE CONFIGURATION 

The MODEL in Figure N2.1 is generally the expected equations of 
motion of the vehicle, without noise. The general MODEL is given by 
equations Nl.1 and Nl.2 with v and w set to zero. The modeling process 
is, in that case, the fitting of a deterministic structure to a noisy 
system. The specialized MODEL used in this thesis is given by 
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equations Nl.4 and N1l.5 with v = O and w=0,. The COST FUNCTION is 
given by equation N1.6 for the integral error-squared case and is 
computed or incremented at each time step of the model and system 
outputs. 

The DECISION AND MODIFICATION block in Figure N2,.1 takes the 
present and past values of C (u, p) and calculates a new value of 
the model parameter vector p, There are many algorithms which may 
be used for determining the new value of p (B~7) (B-1) (R-12) etc., 
and the specific algorithm used determines to a great extent the 
characteristics and value of the model reference method for a partic~- 
ular system. For a given input function u, the cost function becomes 
solely a function of the parameter vector p. In this case the 
Sopeimum or the “identified” value or values of p are those which 
minimize C (p). 
N2.2 MODEL REFERENCE COMPUTATION STEPS 

Now that the basic configuration of model reference identifi- 
Cation in Figure N2Z.1 has been explained, the detailed computation 
steps involved can be presented as Steps N2.1 througn N2.5. The first 
Step in this method of parametric identification is to collect the 
Feta from the system to be modeled. In the case of an ocean vehicle 
this step would be a full-scale sea trial with a set of maneuvers u 
and a set of measurements of the vehicle behavior z In the case of 
a physical model this would be an experiment in a towing tank with 
data recordings of the vehicle inputs u and the vehicle responses 2. 
In the case of a simulated ocean vehicle, as in this thesis, step N2.1 
would be the computed solution to equations N1.4 and N1.5 for a fixed, 
assumed, predetermined, or starting set of parameters p, In a)l of 
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Model Reference Conputation Step 





Step N2.1 Collect or generate noisy data z and inputs u 


Step N2.2 Using the inputs u run the model for a fixed set 










of parameters p 


Model 


Step N2.3 Calculate the cost function C (p) 


+ | Weighted al pe 
e = "| Squarer ee ¢ (2) 
z_(p) 


Step N2.4 Calculate a new value of p by some decision and 


is 


IN 


modification algorithm 
Step N2.5 Branch to Step N2.2 and continue until complete or 


until C (p) is minimum 


these cases the data which results is the time history, either contin- 
uous or discrete, of the inputs u and outputs z of the systen., 

Once the data in step N2.1 has been collected, the process of 
analyzing it to determine the model parameters can pect. The ident~ 
ification procedure may be an on-line, real-time process in which an 


on-board computer calculates and updates the parameters at each system 


Lose 





time increment. If this is the case, the identification computations 
must be completed between the process time steps, which may require 
a fast computer or general model simplifications. The identification 
procedure may also be an off-line or non-real-time process in which 
the data is collected during the running of the system, and then 
processed at a later time. The off-line process is more realistic 
for ocean vehicle identification applications and is the one to be 
Utilized in this thesis. 

The computation steps for processing the data generated in 
step N2.1 to determine the model parameter vector p using the model 
reference configuration appear here as steps N2,.2 through N2.5. 
otep N2.2 essentially says “try the Bee a inputs u on the model with 
one parameter vector p and generate the model outputs 2°" Step N2.3 
then says “calculate how close the model was to the system for that 
pe" Steps N2.4 and N2,.5 then say “using our knowledge of the system 
and our experience at trying different values of p and getting a 
larger or smaller C (p), we'll decide on another value of p to use 
and try again until we can't get C (p) any smaller." Thus, the model 
reference identification technique can be viewed as the system shown 


aoePagure N2,2 in which the inputs are u, V, Ws and p. while the 


Outputs are sets of p's and their corresponding C (u, p)'s. 





Vv Model Reference 
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Figure N2.2 WODEL REFERENCE IDENTIFICATION SYSTEM 
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N2.3 FURTHER COMPUTATIONAL CONSIDERATIONS 

Several things can happen during the model reference identifi- 
cation process which may make its results useless, make the technique 
inapplicable to a given system, or cause erroneous conclusions to be 
drawn from the results. In the first phase, certain values of p in 
the mathenatical model may result in unstable solutions and thereby 
meaningless or infinite values of both 2 and C (p). ‘The values and 
ranges of p must be specified to avoid unstable solutions or perhaps 
singular solutions, 

Another possibility is that the mathematical model structure 
could be erroneous or inadequate, In that case the model reference 
technique would still give values for p and C (p), but the minimum 
value of C (p) might be very large, indicating that no value of p 
really brought the model close to tne system, This kind of behavior 
could also be expected when the input noises or uncertainties were 
very large in comparison to the system variables, In the case of 
improper structure, the mathematical model structural changes which 
resulted in lower values of C (p) for a given input should probably be 
retained in the model, It could be expected that different values of 
the optimum p would result from these changes, 

A similar situation derives from a possible misunderstanding of 
the meaning of identification, Parametric identification as defined 
in Chapter N1 does not imply that a single value of p which perfectly 
models the system exists or is desirable. No specification was made 
as to "how close" the minimum value of C (p) had to be to zero in 


order to call the system "modeled." In general, the desired closeness 
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of modeling depends upon the purpose for which the model is to be 
used (A~-13). Therefore, if a given system results in a large sae: 
of p's which minimize C (p), the statement that p is "unidentifiable" 
because a. Single value cannot be found to model the system is erroneous. 
The stated criterion vas to minimize C (p) and any p which does so is 
an “identified" value. However, suppose that for a given system and 
input every value of p resulted in the same C (p), then by the para~ 
metric identification problem definition of Figure Nl.l, p would be 
completely identifiable since any value of p would minimize C (p). 

In this case considerations external to that defined problem would 
enter and say whether or not the system was adequately "nodeled” by 
any value of pe Model structure or input function changes would 
probably be indicated at that point, 

A final possibility is that the inputs to the system and model 
might be of such type that variations in p might be meaningless, as in 
the previous example. To further illustrate this point, consider a 
noiseless vehicle initially at rest and with all inputs set at zero. 
In that case, all outputs would be zero and C (0, p) would be a constant 
C for all p. If the input were changed, however, the values of C (p) 
would probably changee Thus, the object of modeling is to finda 
structure and set of parameters p wnich, in some limited sense, result 
in a minimum set of C (u, p) which are valid for a number of different 
inputs u and produce the same optinum set of ea as Pe 
N2.4 COST FUNCTION PLOTTING 

The model reference identification technique has been previously 
described as an evaluation of C (p) over a limited space of parameters 
p in such a way that a specific p is found which minimizes C (p). | 
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The outputs of the model reference system in Figure N2.2 are the 
spatial values of p and their corresponding cost functions C (p). 
If the optinum value of p is designated p*, and its corresponding 
minimum value of C (p*) is designated C* ; then for a scalar 
parameter p a typical cost function curve might be as shown in 


Figure N26 36 





Figure N2.3 EXAMPLE SINGLE PARAMETER COST FUNCTION CURVE 


If a predetermined range for p were set Ly, <p < Pid, and then 
the values of C (p) were computed at increments of p within that 
range; then the plotting of the values of C (p) vs. p would allow the 
observer to minimize C (p) simply by looking at the plot. The actual 
Hinimization is in that case performed by the person reading the plot 
and not by a decision and modification role, such 2s a gradient 
algorithm (B-?). 

This type of model reference identification has both advantages: 
and disadvantages. The primary advantage of the plotting technique 
is that it provides the plot reader with more information about the 
parametric behavior of the system than just the values p* and C*, 


By observing the shape and magnitude of the curve, the plot reader 
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can instantly see such facets as multiple minima, absolute and 
relative minima, sharpeness or well defined shape of the mininum, and 
the overall slope and value of the cost function over the specified 
range of p. In effect, the plot provides not only identification 

but also identifiability information about the behavior of a specific 
parameter, 

Another advantage to the technique is that it is a well specified 
computation problem. Tnis means that it does not require any exten- 
Sive computation in the decision and modification algorithm, since the 
new value of p is merely the old one plus an increment, 

The primary disadvantage of this form of plotting techniaue is 
that, in general, a larger number of parameter values and corresponding 
cost function values must be computed than for a technique using a 
computed decision and ROUECaC ion routine. This becomes very signifi- 
cant when the amount of computation involved in each evaluation of 
C (p) is large. For the case in which p* was located in the center 
of the range Lp. <p <P] and in which the increments were set equal, 
then the curve of Figure N2.3 would require about twice as many C (p) 
calculations as for a gradient algorithm started at Pp, or at Pye 

Another disadvantage of Apes technique is that it only permits 
observation of the behavior of one parameter at a time. If the 
general case of the vector parameter p were to be analyzed with this 
technique, there would be plots required in order to look at the 
selected behavior of the a parameters. However, it is important to 
note here that the p* formed by taking the individual minimum values 
of each of these curves would NOT in general. be the optimum p* for | 


the system when all of the parameters were varied at once. In order 
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for this to be true, the individual parameter must be shown to be 
"uncoupled" in the system equations in some manner, 

In the case of ocean vehicle coefficients and parameters which 
enter as products of states in a linear fashion, it is expected that 
theoretical investigations could show which are coupled to which. 
Certainly one would not expect a coefficient such as Ba to be 
coupled to ae but one would expect Xu to be coupled to ee Thus, 
in some cases these independent, individual plots would be very useful, 
but in other cases they would be inapplicable, 

With the initial study of an ocean vehicle's coefficients and 
parameters in mind, an overview of the above advantages and veneers 
tages leads the system modeler to the conclusion that the knowledge 
of identifiability is worth its cost. However, it is more efficient 
from the standpoint of the human visual interpretation process and 
from the standpoint of practical decoupling of ocean vehicle nodels 
to look at the behavior of two parameters at once. This leaas to cost 
function contouring. 

N2.5 COST FUNCTION CONTOURING 

Per ese there are two parameters Py and Po in p which are of 
Specific interest. One way of applying the previously discussed visual 
identification procedure is to attempt to make a three~-dimensional 
plot using contours of the cost function over the defined space of Py 
and Po on a two-dimensional plot. Such a set of contours would appear 
as Figure N2.44 for the case in which the ranges of the parameters are 
Lp. ay) < P| andl p. < Py < py I. The curves in Figure N2.4 represent 
lines of constant values of C (PD). P,) with the minimum values being 


at the center and the maximum values along the edges of the plot. 
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C= min = C* 


Figure N2.4 EXAMPLE DUAL PARAMETER COST FUNCTION CONTOURS 





Visual inspection of this set of contours shows that in this case 


C (ps P,) js shaped like a bowl with a clearly defined minimum at 


3p). 


In some cases it may be desirable or necessary to greatly 


(p)* 5 p 

accentuate the minimum value of C* in Figure N2.4, This can be 

acconplished by contouring the HO Ace Thi 10, C (p) VS. Pp 

or by using some other form of weighting curve for the cost function. 
All of the considerations, advantages, and disadvantages which 

were discussed concerning cost function plotting in Chapter N2,4 

apply also to cost function contouring. The big advantage of contouring 

vs. plotting is that the coupling of two parameters can be easily 

observed, and thus coupling ties amoung parameters can be established 

in pairs. However, even with the pairs and their associated coupling, 

the set of individual optimal pairs may not be the totally optimal p* 

because there may be higher dimensional coupling. Another significant 

consideration is that whereas the cost function plotting was estimated 

to require about twice as many calculations as a gradient algorithn, 

the cost function contouring is estimated to require about een, tines 

as many calculations as a gradient algorithm, where n, is the number 


or paraneter incremental values, However, this method offers great 











promise for ocean vehicle coefficients through second-degree and is 
the model reference technique enployed in this thesis for studying 
coefficient and parameter identifiability. 

This chapter has presented an overview of model reference identif- 
ication and the specific techniques of cost function plotting and cost 
function contouring. The techniques of this chapter are applied to 
simple ocean vehicle models in Section 4 (P) and to the complete 
DSRV dynamic model in Section 6 (C). The primary benefit deriving 
from the application of this method is a knowledge of the identifi- 
ability characteristics of the parameters, especially in the presence 
of noise, The next chapter presents the equations and a discussion 
for the method of extended Kalman filtering, This method, unlike 
model reference, takes ie account the characteristics of the system 
noises v and w and uses a decision and modification algorithm to 


Caiculate the successive values of p to minimize C (p)e 
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CHAPTER N3 


EXTENDED KALMAN FILTERING 

Another method which can be applied to the parametric identifi- 
cation problems of Chapter Nl is that of extended Kalman filtering. 
Kalman filtering is essentially a linear technique with a firm theo- 
retical foundation which, when extended to specific nonlinear systems, 
loses its theoretical foundation but sometimes works extremely well. 
This chapter presents the linear Kalman filter equations from the 
literature and then presents the extended equations for nonlinear 
systems. These equations will be used in the DSRV example coeffi- 
cient studies of later sections of this thesis. Kalman filtering is 
a technique for estimating the state of a linear dynamic systen,. 
Therefore, the first step in applying such a technique to parametric 
identification problems is to convert them to state estimation 
problems, 
N3.1 CONVERTING PARAMETRIC IDENTIFICATION TO STATE ESTIMATION 

Identifying parameters can be made equivalent to estimating 
states simply by treating the parameters as states in the dynamic 
system. In effect this is merely a redefinition of the state vector 
X in equations Nl.1 and Nl.2 to include the parameter p as in 


equations N3.1, N3.2, and N3.3. The structure vectors f and h are 


xX = A <——— From equations N1l.1 and Nle2 N3.1 
. Tt 

Pao comet) ¢ f£=1f. ee] Eq. Nil N3.2 
2h n 


bh (xe, vy t) goho= bh Eq. N12 N3.3 
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similarly augmented with the structure relationships for the paran- 
eters (i.e. p= g). With this definition the parametric identifica- 
tion problem of Figure Nl.1 becomes the state estimation problem 


of Figure N3.l,. 


Given: 
State Equation 
x= f (x, uw, w, t) N3.2 
Measurement Equation 
zh (x) ws ve t) N3-3 
cc c(eza) gee > © | N34 
Using: 
u(t), 2 (t), £, gs hy x (4), tC 
Find: 


x (t) to minimize C (or to maximize -C) 


Figure N3.1 A GENERAL STATE ESTIMATION PROBLEM 


The ocean vehicle paranetric identification problem is converted 
to an ocean vehicie state estimation problem in exactly the same 
manner. If, in addition, it is recognized that the input functions 
u (t) are known vehicle maneuvers (functions of time) and are not 
optimal control inputs which might depend upon the state, then the 
emrect of Ge) is simply to make £ behave as a time-varying systen, 
With these considerations, the ocean vehicle parametric identifica- 
tion sassler of Figure Nl.3 becomes the corresponding state estimation 


probiem of Figure N3.2. As mentioned in previous chapters, the model 
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equations for calculating z 


, axe the state and measurement equations 


with the noises v and w set to zero. 


Given: 
otate Equation 
x = £ (x, t) +H 


Measurement Equation 


Z=X+tv 3 j%X%X& = primary states only 


Cost Functional 


ae 
ee 


: ae (z 
n ~ 


z._) 


z he 


O 
Using: 
2 coe f, x (tos bas C, g=0 


Finds: 


x (t) to minimize C (or to maximize -C) 


Figure N3.2 THE OCEAN VEHICLE STATE ESTIMATION PROBLEM 





Neither of the state estimation problems in Figures N3.1 and 
N3-2 has a general solution or a directly applicable general solution 
technique. The complexity of these very general problems must be 
Significantly reduced before any general techniques are applicable. 
The next steps in the equation developments of this chapter are, 
therefore, to present a general problem which is solvable, namely 
the linear problem, and then to extend it to a reduced version of the 


ocean vehicle state estimation problem and present the corresponding 


Equations. 
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N3.2, KALMAN FILTERING FOR LINEAR SYSTEMS 
Tne Kalman Filter equations, their derivatives, their applications, 
and their theoretical foundations are presented in many different 
forms throughout the literature. The basic form to be used in this 
thesis is given by Brock (B-8), and similar forms appear in Bryson and 
Ho (B-7), Ho and Lee (H=-3) and Sage (S-3). Brock's development and 
explanation of these filtering equations and of the overall filtering 
process is somewhat unusual in that both continuous and discrete 
equation forms are used, However, this seems to allow simpler 
notation and more straigntforeward computational implementation 
than either completely continuous or completely discrete forns. 
In the general paremetric identification problems of Chapter Nl 
and in the model reference identification technique of Chapter N2 
no assumptions were made concerning the characteristics of tne 
Stochastic processes (or noises) vy and we. The basic Kalman filter- 
ing technique for linear systems requires rigid assumptions of the 
form of v and w and known numerical characteristics of these two 
noises. Specifically, v and ware assumed to be zero mean, uncor= 
related, gaussian white noise processes described in equations M4.7 
through N4.10 with assumed or known process noise covariance Q and 
measurement noise covariance R. The Kalman filter can then be shown 
(B-8) (H-3) to ve the optimum estimator for the state of the given 
linear system. Discrete noises w,, v, are used in simulations (Chap. Tn 
Developments in the literature also permit the application of 
the linear Kalman filtering technique to systens with relaxed 


constraints on the noise characteristics. <A large number of these 
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extensions with regard to the characteristics of v and w such as 
non-zero mean, correlated, time structured, and non-gaussian v and 
w are discussed by Schweppe (S-6). The system in which the matrices 
Q and R are unknown and must be determined is discussed by Abramson 
(A-2). 

The Kalman filtering technique is presented here by describing 
its computational steps, as was done with the model reference 
technique in Chapter N2. These steps and their corresponding 
equations ae presented as steps N3.) through N3.8. In both the 
model reference and the Kalman filtering techniques the first step 
1s to collect or generate the noisy data z and inputs ue. For the 
Purposes of this thesis those values will be discrete time values 
of the system inputs and outputs, although the procedure is somewhat 
the same for continvous-time system data (B-7). The Kalman filtering 
technique implicitly assumes that the data is produced by a linear 
system, and so in the case of simulated data, a linear system would 
be used. 

Steps N3.2 through N3.8 provide an iterative procedure for 
processing the noisy data generated in Step N3,1 in such a way as to 
get optinal estimates of the system states at each time step tye 
The continuous differential equations in N3.1, N3.2, and N3.3 are 
Solved in this thesis by a digital computer using an Euler integrator 


es given by Equation N3.8. However, more sophisticated integration 


Migr = y+ Aya ty yy - t,) ee 


techniques, both implicit and explicit, such as Runge-Kutta or 


Adams-Moulton, could be employed here (H=-5). 
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Kalnan Filtering Computation Steps 





Step N3.1 Collect or generate noisy data z and inputs u 


x= F(t) x +0 (solved discretely by 
computer for z at 

a2=HX+V time t, ) 

we E(uj=O-veeLv] N3.1 

Q=E Cux] ; R= [vv] (uncorrelated w, and vy 

a) 


Step N3.2 Propagate the estimated state x one time increment ty 


NN 
ee X(t.) RX. 


i* 


re Meee 
Cie es 
ices 11 — 
Step N3.3 Propagate the error covariance matrix E 
E = ff + er + Q : H(t ) = EL x x sy 
O =<) 
Ex ELee]=ee + e=x-x 


e = state estimate error; carat denotes estimate 
Step N3.4% Calculate the Kalman filter gain matrix K at Ce 

K = EH (et 4. ane | N3.4 
step N3.5 Update the estimated state x to x at t, 

Kim XK (2-2) ¢ zy = 2(t,) N35 
Step N3.6 Update the error covariance matrix E to E* at Ce 

Bf = EB - KHE N3.6 


Step N3.7 Set x! and E* as initial conditions for 
Steps N3.2 and N3.3 at t., 


z (t,) = x (4) 
B(t,) = BF (t,) 


Step N3.8 Branch to Step N3.2 and continue until the end 
of the process. 


N3.7 


ee a ES et cee ee 
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Many of the problems encountered in the model reference tech= 
nique may aiso be encountered with Kalman filtering, both system 
problems and computation problems, Most of these are treated in the 
same manner for Kalman filtering as they were for model reference 
in Chapter N2. One computation problem which may be encountered is 
that of the error covariance matrix E going negative at some point 
in the process. This may result in the process becoming completely 
unstable at that point because of the nature of equation N3.6. The 
causes for negative E may lie in the violation of some of the basic 
theoretical rules for Kalman filtering, or the causes may be that 
the computer has insufficient accuracy or that the time steps were 
chosen too large. 

N3.3 KALMAN FILTERING EXTENDED TO NONLINEAR SYSTEMS 

The linear Kalman filter is also valid for nonlinear systems as 
Jong as it can be shown that the errors in the estimate of the state 
can be approximated by a linear system. The detailed steps and 
theoretical considerations for this extension are presented by Brock 
(B-8) for the nonlinear system in equations N3.9 (slightly different 
notation). 
£ (x, Ww, t) 


‘ee Ve t) 


I~ 
y 
va) 


N3.9 


JN 
H 
{= 


The equations N3.9 are inserted into Step N3.) in order to 
generate the data using a general nonlinear stochastic system. The 
equations N3.2 in Step N3.2 are replaced by equations N3.10 which 


have the same structure as equations N3.9 with w and v set to zero. 
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N3.10 - 


The error covariance matrix equation in Step N3.3 is replaced by 


equations N3.11, and the Kalman filter gain equation in Step N3.4 


B= FR + Ee +- Qa 


N3e11 


he} 
i! 
5S 


mw 
Ir | 


aon 
ou 


=i 
i" 
QW 
1= | 


is replaced by equations N3.12. With these substitutions the 


“9 
K = EHD (Hen! 4. R) 


dh @, t) 

Hey N3.12 
dh R gh? 

Ri = dv dv 


conputation steps N3.1 through N3.8 become those of the general 
technique of extended Kalman filtering. 
N3.4 EXTENDED KALMAN FILTERING FOR OCEAN VEHICLES 

The extended Kalman filtering steps for the ocean vehicle state 
estimation problem can now be derived and presented as Steps N3.9 
through N3.16 and as equations N3,13 through N3.19. There are several 
very significant simplifications which result from the symmetry of 
the E matrix and from the fact that the parameters p in equation N3.1 
are assumed to be constants (i.e. g = 0). | 
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step N3.9 Collect or generate noisy data z and inputs u 


x = Ge tc) +w 3; YL from equation N1,/t 


Nowe 3 
w= HX + Vv (solved discretely for z,) 
Step N3.20 Propagate the estimated state X to oe 
4 A 
x= f (x, t) 3; £ from equation N1.4 
N3.34 
z = HR 
=n “= 


Step N3.11 Propagate the error covariance matrix E to ty 
B= FE+ EF +9 


f (x, t) N3.15 


ox 


, 
a» 


ra 


Prep Nj-l2 wCaleulate the Kalman filter gain matrix Ket t, 
Keo mH! (HEH’ +R) | N3.16 
Step 3.13 Update x to 5a, at . 
x ~ k + K (a= z) ; = z(t) N3.1L7 
Step N3.14 Update E to E® at t 
E* = BE = KHE . | N3.18 


Step N3.15 Set Xt and E' as initial conditions fer 
propagation equations at vy 


& (t,) = & (+,) 
E (t,,) * B* (+,) 


N3.J.6 Branch to Step N3.10 and continue until the 
end of the process 


N3219 


wee ae EE ewe ee es ee ee eee ee ee oe eee ee, ee ee ee 


suppose that these ere ne States and ur parameters in the ocean 
vehicle model. This means that the state cstimation problem has 


a ny states and that equations M3.14 are actually structured 
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as in equations N3.20 and N3.21. ‘Therefore, instead of integrating n 


; “A w~N 
A x £ (xn p, +) where £ is n_*1 
e — Se, “tiger tea S 
Bape) feo N3.20 

p 0 0 is n_*] 

5 a p 
Tata 2 
n*n ; mm | 7 |e. 

Z. * i “ = HX N3.221 


differential equations in equation N3.20, only ie equations need to 
be propagated. In addition, the H matrix which has dimension n*n 
actually has only n.. nonzero elements wnich are the Hes = 1] identity 
matrix diagonal elements, 

Further reductions occur in Step N3.1] because of the symmetry 
Of BE (E = gt) and the form of equation N3.20 applied to equaticns N3.15. 
Normally the E matrix is n*n, but the fact that it is symmetric means 
that there are n (n + 1)/2 unique elements, The gradient matrix F 
is also of a special form described by equation N3.22; and when 


included in the error covariance matrix propagation equation, the 


de GB. t) : df G, 8 t) 





te, a n *n ‘+n *¥n 
ox ' Ox ; Se Ss 
aren ee ee ee sles ct. ns--s-1OL dimensions | -..-2. 1 aeons P 
; 0 nN.*n it on 
si; p 
N3.22 


form of equation N3.23 results. The fact that there are significant 
Numbers of zeroes in F reduces the number of nonzero elements in the 
B equation N3.23 to a total of n. (n. +: an). The symnetry of E and 
of Q further reduces the total number of propagation equations to the 


n, values of equation N3.24,. 
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These reductions are highly significent from a computational 
standpoint and lead to the possibility of solving equations with 
large numbers of ocean vehicle parameters. The total number of 
differential equations which must be propagated in Steps N3.10 and 
MGell is n, +n, Similar considerations to the above lead to 
Simplifications in the Kalman filter gain matrix calculation and 
in the updating equations. The K matrix is of dimension n*n. but 
it 


only requires the inversion of an n*n, matrix because of the HEH 


structure and the fact that the matrix R is of dimension nn 


Ge 





The form of H in equation N3.21 greatly simplifies the computation 
of the K matrix. The updating equations require n updates for the 
states and n-(n + 1)/2 updates for the error covariance matrix. 

Consider an example case in which the number of primary states 
is 6 and ce number of parameters is 194 for a total of 200 states 
in the estimation probleine In this case n_* 6 and n, = 1155 fora 
total of 1191 differential equations which must be propagated. Tne 
K matrix calculation requires the inversion of a 6*6 matrix and is 
of dimension 200 * 6. There are 200 updates for the states and 20100 
updates for the error covariance matrix for a total of 20300 updates, 
These example numbers are really not intended to present an accurate 
measure of the raccoon effort involved, since this eee 
depends upon the complexity of the basic system structure f, 

This chapter has presented the, extended Kalman filter equations 
for application to ocean vehicle parametric identification. Tne 
parametric identification problem was first converted to a nonlinear 
State estimation problem, and then the linear Kalman filter equations 
were extended to apply to that pean problem. The detailed 
computational steps were listed for the linear, nonlinear, and ocean 
vehicle state estimation problems. In addition, several computa-~ 
tional simplifications were derived for the ocean vehicle problem. 

An overall system view of extended Kalman filtering is presented in 
Figure N3.3, where the x (t) contains the parameters p (t) in 
Figure N2.2, and the error covariance matrix E (t) is a measure of 


confidence in the values of x. 
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Figure N3.3 EXTENDED KALMAN FILTERING SYSTEM 





The next chapter presents the basic equations and considerations 
for studying the identifiability of specific parameters in nonlinear 
dynamic system mathematical models. Both model reference and extended 
meatman filtering can be used to study identifiability, and the next 
chapter describes in detail how each technique can be used for this 


purpose. 
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CHAPTER N4 


STUDYING IDENTIFIABILITY OF PARAMETERS 

One primary reason for using identification techniques on ocean 
vehicles is to determine their mathematical models for the purpose 
of simulating the motion of ‘the vehicle. Identifiability must there- 
fore be viewed from the standpoint of the overall mathematical 
modeling objective or system modelability rather than from the 
standpoint of solving a specific parametric identification problem, 
This represents a somewhat more general view of identifiability than 
the view presented in the discussions of Chapter N2.3 in that not 
only must p* minimize C (p), but C (p*) must also satisfy the system 
modeler’s criteria for a good mathematical model. If the cost 
function C(p) is truely designed to represent the closeness between 
the model and the system, then one’ of the modelability or systen 
modeler's criteria might be interpreted as minimum C (p*). 

In this thesis the parameters for the mathematical model of the 
DSRV are studied for their identifiability characteristics by using 
a known set of parameters and a conputer simulation with added noises 
to generate the data for use in the model reference and Kalman 
filtering techniques. If these identification techniques result 
in the true or known set of parameters, then the system modeler’s 
eonitidence in the identifiability of re same parameters when found 
from real vehicle data is greatly increased. However, if the true 
or known set of parameters are not found, then the system modeler 
must question many of the original steps used in the modeling and 
identification processes. In this case the conclusion might be 


reached by the system modeler that the original varameters are 
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unidentifiable either with or without noise, This conclusion, if 
well founded, would be valuable information from the standpoint of 
the time saved trying to find unidentifiable parameters from the real 
vehicle data, If the true or known set of parameters are shown to 
be identifiable with multiple values which minimize C (p), then the 
system modeler can use this information in interpreting the param- 
eters found from identification passes on real vehicle data, In 
sunmary, identifiability studies provide the system modeler with a 
“bridge" between the mathematical model parameters found from simu- 
lated data and those found from real vehicie data, In this thesis 
identifiability studies will be concerned with finding the original 
set of parameters used in the vehicle simulation rather than eh the 
single problem of mininizing C (p). 

There is at present no absolute or universally accepted definition 
of identifiability for parameters in mathematical nodels (S-6, 
Chap. 18). First of all, there is no guarantee that the general 
parametric identification problem is solvable or that there exists 
a p* which will minimize a general. oriehacess cost function C (p). 
Then if C (p) can be shown to have a mininum value, there is no 
guarantee that such a minimum is unique or that the actual minimizing 
value(s) of p* could ever be found, Identifiability, therefore, 
might refer to the capability or theoretical possibility of finding 
a p* to minimize C (p), or identifiability could be some measure of 
the computational Petia et involved in finding one or more values 
of p* accurately for a given form of C (p). 

This chapter presents a general view of the concepts of model~ 


ability and identifiability. For use in this thesis a general 
=e 





definition of modelability is given, and then identifiability is 
defined and shown to be one of the factors affecting modelability. 
These definitions are then interpreted in terms of both quantitative 
and qualitative measures, and the direct applicability of these 
measures aie identification studies of the DSRV and of other 
vehicles is discussed. 


N4.1 THS CONCEPTS AND DETERMINING FACTORS OF MODELABILITY AND 
TDENTIFIABILITY 


In Chapter Ml.1 the concept of understanding the behavior of a 
physical system, namely an ocean vehicle, was discussed, There are 
two approaches which can be taken with regard to gaining such an 
understanding: microscopic (theoretical) and macroscopic (praguatic). 
in the microscopic approach, one begins with the known basic pnysical 
laws of matter and the axioms of mathematics and develops a mathemat- 
ical model for the behavior of the systen with a rationally understood 
and connected set of steps. In the macroscopic encom one begins 
with the characteristics of the input-output behavior of the system 
and attempts to deduce the mathematical model for such behavior. 

Both of tease appreaches contribute to the total understanding of 

the system, but any true or complete understanding of the physical 
system must include the microscopic approach, However, system 
modelability might apply to the microscopic or macroscopic approaches, 

Modelability is the capability of mathematically modeling or 
Simulating a physical system. In this thesis the physical systems to 
be modeled are ocean vehicles or physical models of ocean vehicles, 


but the concept can be applied to any physically existing dynamic 


System. Note, however, that modelability does not imply or require 
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a complete understanding of the system, but that such an understand- 


ing would imply modelability. This thesis is concerned with model- 


ability as applied to the macroscopic approach for modeling physical 


systems as state determined dynamic systems (Section M). 


Let the modelability of'a physical system be designated by the 


scalar functional M and the identifiability of a set of parameters 


in a general parameter vector p by the scalar functional I, The 


modelability and identifiability functionals can then be described in 


terms of the factors in the modeling process upon which they are 


dependent as in equations N4,1 and N4.2. The dividing line between 
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M = mathematical modelability measure 


I = parametric identifiability measure 


—] 
y 


dependent variables of I (D) 

S = dependent structure of M (S, C, I); 

S = all except C and I 

M and I need not be as specific as in equations M4.1 and N4,.2, and 
fn fact many of the dependents in these two equations could apply to 
both functionals. The modelability definition used here has M 
primarily dependent upon the structure of the system and of the 
modeling process, and the identifiability definition is set up to have 
I be dependent upon the numerical values in the parametric identifi- 
cation process for a fixed structure and modeling procedure, ween 
are many other factors which might be included as dependent func- 
tionals in M and I such as the size and speed of the computational 
MENTE TE cibe used in the modeling and identificationsprocesses, 
ae available manpower to formulate the problems, the available 
Computation time, desired model accuracy, etc, 

The system modeler begins by specifying the structures of the 
dependent functionals in M, and then proceeds to specify the depen- 
dent variables in I. Then the parametric identification problem is 
investigated to determine its parametric identifiability; and if the 
parameters are identifiable, then one or more values of p* which 
minimize C (p) are determined, If the parameters in the parametric 
identification problem are not identifiable or if the value of C (p*) 
is too large to allow the system to be called “modeled,” then the 
structure of the functional dependents in M is varied and the entire 


process repeated iteratively until satisfactory modeling is achieved, 
~1l22~ 





A similar iteration process can be described for the solution to 
the general parametric identification problem. The dependent variables 
in I are specified and attempts are made to find p* to minimize 
G(p*). If this is impossible or too difficult, then the dependent 
variables are changed in some manner; and the identification process 
is repeated iteratively until satisfactory identification is achieved 
or until the parameters are shown to be unidentifiable. A flowchart 
for the modeling and identification ideas discussed above is presented 
in Figure N4.1. The overall goal of the system modeler in Figure N4,1 
might be to find the S* which would minimize C (p*, S). 

The studies in this thesis are especially relevant to the identi- 
fying process and specifically to blocks 4 through 9 in Figure N41. 
In Sections 2 (M) and 3 (N), and 5 (D) the structure of the modeling 
process is specified as to the structure of the equation and the 
identification procedures to be used. Sections + (P) ana 6u(G) 
represent the theoretical and DSRV example steps to be followed in 
blocks 5 and 6 of Figure N4.1. Another systen modeler would have to 
tailor the blocks in Figure N4,] to his specific dynamic system and 
his facilities for studying it. Several explicit quantitative and 
qualitative methods for studying identifiability for a specific ocean 
vehicle's parameters can now be developed, These identifiability 
measures are discussed in the remainder of this chapter and applied 
to the DSRV mathematical model in Sections 4 (P) and 6 (C). 

N4.2 IJDENTIFIABILITY FOR OCEAN VEHICLE PARAMETERS 

it is now desirable to specialize the general procedure of 

Figure N4.1 to the models of Section M and the identification tech- 


mqwes of this section. This means that the forms of S and C in 
me 3 
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Figure N4.1 FLOWCHART FOR MODELING AND IDENTIFICATION 
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equation N4,1 are fixed to those equations and identification tech- 
nigues previously presented and are summarized in equations N4,3 and 


N4.4, With these structural functions now fixed, the identifiability 
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N2.5 for model reference contouring 
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of the specific parameters of an ocean vehicle can now be defined, 
discussed, and measured, 

A parameter P; belonging to the yector p will be texmed identifti-~ 
able if one or more values of p,* may be found from simulated vehicle 
data by model reference contouring or by extended Kalnan filtering. 
ieeeidentifiability of Pp; will then refer to the ease with which 
one or more values of p,* nay be found or “seen" in the model referenee 
contours and to the accuracy with which it may be determined by 
extended Kalman filtering. 

It is important at this point to ensure that this definition 
be interpreted properly, and not be placed at odds with the discussion 


-125- 





mathe introduction to this chapter or in Chapter N2.3. Equation 

N43 Ressaltios modelability or that C (p*) will be small enough that the 
vehicle will be adequately modeled by the structure and value of p*, 
This also implies that C (p) has some structure to it which will 
preclude the possibility of all values of p minimizing C (p). ‘There- 
fore, somewhere within the space of all possible values of p 

[i.e. (-o < p< + co) | there must be a subspace of values which will 
minimize C (p). It is therefore possible to talk about the diffi- 
culties involved in finding that subspace, 

In the identification studies of this thesis an ocean vehicle 
(DSRV) is simulated using the model structure, gaussian white noise 
processes, and a fixed set of parameters p*., Noisy input-output data 
is collected from this simulation and processed using the identifica- 
tion techniques to determine p* once again. The closeness with which 
these procedures give the true value of p* then determines how well 
aientification procedure works, how easily and accurately the 
parameter is identified, and to some extent wnether, if the parameter 
p* were unknown for a real vehicle, the identified value would 
adequately model the real vehicle. It is for these considerations in 
this thesis, that identifiability is concerned with the difficulties 
involved in finding a specific and unique minimizing value of p* 
accurately, in finding if multiple values of p* exist, or in finding 
if p* is unidentifiable. There are both quantitative and qualitative 
measures of identifiability which can be applied to the provlem of 
finding p* from simulated vehicle data. 

N4.3 MEASURES OF IDENTIFIABILITY 


The identifiability I of a parameter vector p for the ocean 
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vehicle mathematical models studied in this thesis depends, as in 
equation N4.4, upon the input function u, the starting values of the 
parameters Poe and the noise parameters Q and R. In order for I to 
be a measure of the difficulties involved in finding p*, it must in 
some manner be a function of the characteristics of C (p), since 

the minimization of C is the goal for the identification of p*, In 
the Kalman filtering technique, I must be dependent upon those final 
states which are parameters and upon their final error covariances, 
Since these determine how accurately the parameters have been 
identified, 

The identifiability of a parameter is a measure function which 
falls into the general category of sensitivity functions or sensi- 
tivity analysis in the area of control theory (S--3) (R-10) (D-10). 
Many quantitative sensitivity measures may be found in this area 
which can be applied to identifiability studies for seen vehicle 
models, but such formulations have not been investigated and are not 
applied in this thesis. The identifiability studies made here 
represent, for the most part, qualitative analyses of the inodel 
reference contours for selected parameters and a qualitative (percent- 
age) judgement of closeness of the estimated parameters and their 
error covariances from the Kalman filtering technique, 

N44 MODEL REFERENCE IDEN TIFIABILITY 

The model reference contouring technique is the primary tool for 
studying identifiability in this thesis, and the system modeler's 
interpretation of those contours leads to his qualitative judgement 
of the difficulty involved in identifying the parameters being varied 


using a more efficient technique. Tne basic considerations applied 
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by the system modeler to the model reference contours are judgements 
with regard to the slopes, shapes, and minimum valucs around the known 
or true values of the paraineters used to generate the data, These 
considerations are described here by presenting example contours of 
the type shown in Figure N2.4 and then describing the identifiability 
Characteristics of these examples, 

As discussed in Chapter N2, many identification techniques repre- 
sent some form of stepping don the contours of the cost function to 
the minimum value of C (p) and then designating that point as p*. 
Gradient methods step down these contours directly, whereas extended 
Kalman filtering steps down these contours using the known or 
estimated noise characteristics to decide upon the best direction and 
amount to step at each contour. Qualitatively then, identifiability 
(as defined in Chapter N42) is determined by the ease, speed, or 
final accuracy with which these methods can step down tHe cost 
function contours generated by the model reference contouring studies, 
Most of the qualitative measures discussed here apply most directly 
to the gradient and contouring methods, but these also represent 
comparable measures for identifiability using extended Kalman 
filtering. 

The applicable identifiability measure will usually depend upon 
the identification method used. In the case of a first order gradient 
method, the most identifiable form of cost function is given by 
equation N4.5 and represents a perfect absolute linear cost function, 
The plot of this cost function is shown in Figure N4&,.2 and would 
appear as a cone for the same form of cost function contoured in 


two dimensions, 


-128- 








SSE 


Figure N4.2 AN ABSOLUTE LINEAR COST FUNCTION 





The reason that this absolute linear cost function is considered 
the most identifiable form for a first order gradient technique is 
that convergence is generated in one iteration step. The first order 
gradient iteration technique for this cost function is given by 
equation N4.6, and the applicable gradient is given by equation N4.7. 
When these two equations are ey the next iteration in pb turns 


out to be p*, which is given by equation N4.8. Thus, no matter what 


initial value ie of the parameter is used, the method identifies p* 


in one iteration, 


Pia = Pn 7 © (e,)/La © (p,)/4 Py NY. 6 

Gee (p,)/a P, = Sign (Pp) aed pe 0 N4,7 
=] P, < 0 

Patl = 0 = p* N4,8 


The primary identification method used in this thesis is model 
reference contouring, where the actual identification is done by 
the observer who visualizes the contours and sees the minimum value 


of C and the corresponding optimum values of Py and. Poe For this 
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merniod, the mosteidentifiable cost function is a "hole" or point 
displayed exactly at the optimum as given by equation N4.9 and shown 
in Figure N4.3. This cost function is the most identifiable because 


it is the easiest one to "see" the optimum C (p*) and the minimizing 


values of Py and Poe 





C=-0 at center 






Pp) * 






Figure N4.3 MOST IDENTIFIABLE C_(P) FOR MODEL REF#RENCE CONTOURING 


There are several types of contour configurations which may 


typically be encountered in the use of model reference contouring on 
an ocean vehicle cost function C (p,» P,) and simulated venicle data, 
The identifiability of the parameters is reflected, in one way or 
another by these configurations, and the system modeler can use this 
waentifiability knowledge to interpret the results of identification 
passes on real vehicle data, Several of these configurations are 
listed below and shown in Figure N4.4,. 

le both Py and. Po identifiable and independent 

Ze both Py and Po identifiable with multiple valucs 

oe p, unidentifiable; C (Pp) Po) = C (P, ) 


uv =p 


7 unidentifiable: C (Py Po) a (p,) 


=. 304 
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3e 


9. 


both p, and Po identifiable 2. both p, and Po identifiable 
and iitependerit with nid ba pee values 





P, unidentifiable; C(D,. Po) 4, p, unidentifiable; C(p,, P.) 


= C(p = (ie 
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linear dependence: 8, functional dependence; 
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Figure N44 TYPICAL MODEL REFERENCE CONTOUR CONFIGURATIONS 
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5. Py hard to identify 
GC; P, hard to identify 
7e linear dependence; P) = a Pp + b 
8. functional dependence; Pp, =f (p,); 
9. partially linear dependence 
10. partial functional dependence 
The case of neither p, nor p 


il 


map (not shown) or a map with completely random contours (not shown). 


identifiable would be a blank contour 


In some cases the contours of Figure N4,4 may become somewhat un- 
certain or “fuzzy” because of the stochastic processes v and yw. If 
the shape of the contours remains somewhat the same for significant 
amounts of v and w noises, then the system modeler may be fairly 
certain to be able to identify those same parameters from noisy real 
vehicle data. 

Qualitative identifiability studies may now be carricd out using 
these contours and their interpretations. Variations are made in 
the eiput function u, the ranges of Py and Por and the noise character~ 
istics Q and Rk. In each case the J oma of the contours is examined 
and the identifiability of the parameters determined for that varia- 
tion. In this manner the system modeler may eventually learn which 
inputs u make the most identifiable contours, what the necessary 
manges for p 


i 


mine p* to a desired accuracy, what types and amplitudes of noises 


and Po and for the contours must be in order to deter- 


cause the parameters to become unidentifiable or hard to identify, 
and which parameters are functionally dependent for a given input u. 
All of this information can then be used to design the inputs and to 


interpret the results of identification studies for real] vehicles, 


=iie2= 





Most of the information obtained by the system modeler concerning 
identifiability should come from model reference contouring, and 
then the actual identifications made on real vehicle data should be 
done using extended Kalman filtering. Model reference contouring 
requires a cent deal more computation (Chapter N2) in many cases 
than does extended Kalman filtering. In addition, the accuracy of 
the optimal parameters or their steady-state estimates can generally 
be expected to be better from the extended Kalman filtering technique 
than from model reference contouring, 

There is some identifiability information which can be gained 
from the use of the extended Kalman filtering technique, but tne 
information is more of a “go or no go" type than that obtained from 
model reference contours. Extended Kalman fiitering results in the 
state trajectories (including parameters) x(t) and their error 
covariances E (t) as described in Chapter N3. In the case of un- 
identifiable or functionally dependent parameters, the parametric 
States in ct) may not converge to Peete ce values or may becone 
unstable and increase exponentially, In some cases the states may 
reach steady-state values which are “biased" away from the true 
values of the parameters: and at the same time, the corresponding 
covariances E (t) may be very small, saying that the filter has a 
hich degree of confidence in an erroneous value of a parameter, 
However, many of the cases in which the extended Kalman filter will 
Not provide proper answers can be explained by using the corres~- 


ponding model reference contours, 
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In later sections of this thesis the outputs of the extended 
Kalman filtering process are displeyed as plots of the parameters p (t) 
and their error covariances E (t). [Example plots of a parameter p (t) 


and its error covariance E (t) are shown in Figure N4,5,. ‘The final 











Figure N4,5 TYPICAL OUTPUT PLOTS FROM A KALMAN FILTER 


values Pp and Ee on these plots are the points of primary interest 

from the standpoint of parametric identification, The final param- 

eter value is interpreted as a gaussian random variable with mean Pp 

and variance E. or a normal random variable of the forn N (Des Ep) 
The identifiability of the parameter p may be judged from 

Figure N4,.5 by how closely the random variable p = N (Ps Ee) corres- 

ponds to the known value of p* used in the vehicle simulation, 

There are both quantitative and qualitative judgements which can be 


made relative to this correspondence, Qualitatively, if p* falls 


within one standard deviation Op of p, as given by equation N49, 
i 


N49 
Vite 


6) 
then the parameter p may in some instances be said to have been 
identified, The difference between Pr and p* is termed the param- 


eter bias. This bias will certainly have a significant effect upon 


Scie 




















any judgement of identifiability for the parameter p and will usually 
be Messed as a perceniage of p*. The identification of p is 
highly dependent upon the initial values N (pos KS) used in the 
Kalman filter, and some qualitative judgements of identifiability 

may be made based upon how much closer N (Pps Ep) is to the true 
value p* than N (Do. EB) was prior to the Kalman filtering. Often 

in extended Kalman filtering the value E 


f 
indicate a much greater confidence in Pp than should be accepted by 


may become very small and 


the system modeler, In this case the identifiability judgement 
would be more dependent upon the bias than upon the one-standard-~ 
deviation measure of equation N4.9. In all of these qualitative 
judgements, the system modeler must know how close, percentagewise, 
he needs to identify the parameters in order to have the model 
represent the system. This information is provided in many cases 
by the model reference contours, 

Quantitative judgements or measures of identifiability of 
parameters estimated as states by an exterded Kalman filter must 
reflect the closeness of the state estimates p to the known value 
pe, One such measure is suggested here as a possibility and is 


presented in equations N4.10 through N4.14. This measure is the 


I* = px? 4 og? N4.10 
ox? = 0 N4, ual 
c = ¥)e2 * OT ~~ %)2 ’ 
Ue een) 4 (o, o*) N4.12 
i =I /I* N4.13 


normalized vector distance (for k = 1) between the true parameter 
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p* = N (p*, o) and the identified value p = NN (Pp, Ee) considering 
the random variable as a vector with elements Pr and Kee The ident- 
ifiability I in equation N4.13 corresponds to equation N4./+ and 
could be computed using different inputs, starting states, and noise 
properties in an attempt to minimize it for the ocean vehicle struc- 
ture and the extended Kalman filtering technique, 

Another possible form for the identifiability measure could be 
the integral of the square of the difference between the extended 
Kalinan filter estimate and the true value p* over the time of the 


filter pass as given in equation N4.15. This measure has the 
tr “aie 
I= ff [ p(t) - p*]? at N4.15 
O 


advantage of reflecting the complete process history but has the 
disadvantage of not including any information or measure concerning 
the error covariance E(t). Variations of the dependent variables 
in equation N4./+ could also be made to minimize this identifiability 
Measure. 

The extended Kalman filter does not provide as much identifiabil-~ 
ity information as do the model reference contours, but it is in 
Many cases a more efficient technique -to use for the actual paran~ 
eter identifications. The extended Kalman filter uses the noise 
characteristics in its estimation of the parameters and is in this 
Sense a much better data processor than model reference contouring. 
In fact, in many instances, the Kalman filter will give better 
estimates of the parameters than one would expect possible fron 


looking at very noisy model reference contours. 
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Two methods for identification of parameters and for studying 
ienetric identiflability have been presented and discussed through- 
out this section. There are significant difficulties encountered 
when model reference contouring and extended Kalman filtering are 
applied to the ocean vehicle mathematical models developed in 
Section M,. Tne difficulties encountered in applying these methods 
and the techniques for overcoming these difficulties remain to be 
discussed before the techniques can actually be applied to general 
ocean vehicle models or to the DSRV model used in this thesis. 


N4.6 APPLICATION OF IDENTIFIABILITY STUDIES TO OCEAN VBIICLE 
PARAMELERS 


inen the ocean vehicle mathematical modeler is faced with a 
system of state equations as complex as those presented in the general 
models of Section M, the solution of the equations, the identification 
of the paraneters, and the making of juagements as to whether the 
Mathematical model really represents the system may appear to be 
inpossible tasks, Tne dimensionality of the equations, the large 
numbers of parameters, the highly nonlinear form of the equations, 
and the significant uncertainties of the process and measurement 
noises all make the mathematical modeling of a specific ocean vehicle 
a formidable problem unless some way can be found to simplify the 
prohleme For sophisticated vehicles the equations will be nonlinear 
and will have noise inputs regardless of the simplifications made, 
but the equations, the effectors, and the parameters may be capable 
Of being decoupled in several different ways for a specific vehicle 
model . 

This decoupling is a key step in making the modeling problem 


Solvable and must be utilized whenever 6 degree of freedom models 


Sieve 








with hundreds of parameters are analyzed with model reference contour- 
ing Ssiraues. The extended Kalnan filtering technique will apply 

to the general. problem but may require an unnecessarily larger 

amount of computation time than thut required for decoupled, reduced 
problems, The manner in which the equations of motion for a specific 
vehicle decouple must be determined by the system modeler through 
analysis, experiment, or simulation. ‘The decoupling of the equations 
will facilitate the design of the input functions, both for the 
Simulated vehicle and for the real vehicle sea trials. 

Mode]. simplification by degree of freedom, effector, or param- 
eter decouplings requires digital computer programming for either a 
set of many different Simplified and decoupled mathematical models 
or for one total mathematical model which is structure selective or 
capable of being automatically decoupled. The single degree of 
freedom equations of Section P fall into the first type of model set 
and represent one type of model which would be required. This set 
of models would have to have many two, three, four, and five degree 
of freedom models in order to represent totally the ocean vehicle 
behavior (specifically for DSRV). For small numbers of parameters 
and for modeling applications eemen great precision is not required, 
it nay be advantageous to develop sets of decoupled models and study 
the parameters of each individually. Then the identified parameters 
could be placed in the total model and, if the decouplings were valid, 
would adequately model the vehicle. ‘The single cegree of freedon 
DSRV equations are the only ones of this type developed for use in 


this thesis (Section P). 
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The structure selective approach is the one taken in this thesis 
and ite the one suggested for any 6 degree of freedom, multi-offector, 
multi-parameter ocean vehicle whose mathematical model must be 
identified somewhat precisely, Stmuicture selectivity is little more 
than a programming technique in wnich the mathematical equations 
are solved only for those degrees of freedom, effectors, and paran- 
eters previously selected by the system modeler. In this technique 
the system modeler specifies the number KB and the indexes L of each 
of the degrees of freedom to be used in the model (B“19). Then the 
digital computer program for solving an equation such as M2, 30 
reduces to one for solving only KB equations, and the summations run 
only over the KB indexes in the vector L instead of over all 6 degrees 
Of freedom. Similarly, the effectors are selected as to their 
number KE and their indexes LE; and the parameters are selected as to 
their number KP and their indexes LP. The use of structure selec- 
tivity requires that a significant amount of computation time be 
spent selecting the degrees of ee effectors, and parameters; 
but the method pays for itself many times over when reduced (decoupled) 
models are used in the system identification techniques, 

» As examples of structure selectivity and for use in later 
Sections Table N4.1 presents several reduced degree of freedon 
models, their indexes, and their applicable effectors for the DSRV, 
It is rather obvious and highly fortunate that reducing the degrees 
of freedom of the model also reduces the applicable effectors and 
Paremeters very significantly. 

The system inodeler begins the study of the identifiability 


Characteristics of the particular ocean vehicle of interest by using 
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single degree of freedom models (equation M2,.30) and the applicable 
effectors and parameters (Section P for DSRV). Simulations are made 
with known or assumed values of p*, and then the identification 
techniques are used to find p* again from the noisy simulated vehicle 
data, to Pe elop the best vehicle inputs for finding these parameters, 
ana to learn about the identifiability characteristics of the param-~ 
eters, This process is then continued with two, three, four, and 
five degree of freedom selected models, selected effectors, selected 
maneuvers, and selected parameters (equation M2.30). At some point 
the system modeler will become confident enouvgn in the behavior of 
the model structure and identification techniques to specify inputs 
for a full scale vehicle or physical model sea trial. Then the data 
from the physical system is processed using the same structure-~ 
selected models as were used on the Saiaten vehicle data. The 
parameters identified from the real vehicle data si teimeeee in the 
light of the identifiability studies made on simulated vehicle data 
should determine the proper mathematicel model for the real vehicle, 
The system modeler must be certain that the measurement structure, 
both input and output, used on the real vehicle is the same as that 
used in the identifiability studies. The total modeling process thus 
follows the flowchart given in Figure N4,1 and is demonstrated in 
this thesis for the DSRV simulated model in Sections P, D, and C, 
Tnis chapter has presented the details involved in using model 
reference contours and extended Kalman filtering plots to study the 
identifiability of specific ocean vehicle parameters, These details 
have been presented in the framework of completely general defini- 


tions of both nodelability and identifiability and in the framework 
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Comments relative to DSRV eff, 





Name Variables KB L 

surge u i [1 | propellor 

sway Vv il e2,] thrusters, shroud 

heave W i ie thrusters, ballast tanks, 
shroud, transfer skirt 

roll p 1 [4] propellor torque, roll tanks 

pitch q ss cai, trim tanks, ballast tanks, 
shroud, transfer skirt 

yaw i: 1 [6] shroud, thrusters 

surge,roll u,P Ze [14] propellor torque coupling 

surge, heave u,wW 2 [13] transfer skirt coupling 

surge, pitch u,q Z [15] transfer skirt coupling 

sway ,roll V,~p 2 [ 24 | CFransier Sir t coupling, 
splitter plate coupling 

sway, yaw Wipe 7s [26 | splitter plate coupling 

heave, pitch Wd Z [35] secondary drag coupling 

roll,yaw jo, x z [46 | transfex skirt coupling, 
splitter plate coupling 

horizontal plane u,v,r 3 [126] all effectors, primarily 
propellor, shroud 

vertical plane Ses ae | 5 [135] all effectors, primarily 
propellor, shroud 

horizontal roll  u,v,p 3 [124 ] all effectors, tanks, prop. 

coupling 
horizontal plane u,v,p,r ly [1246 ] all effectors 
with roll 
vertical plane U,¥, 2.9 uy [1345 ] all effectors 


with roll 


Table N4.1 SELECTED REDUCED DEGREE OF FREEDOM MODELS FOR THE DSRV 


eT See ee ee wes a on ree 8 SE ee eee 


-14i- 





of a flowchart for both modeling and identification. Most of the 
eintative identifiability information has been shown to come from 
model reference contours of the cost function changes under paran- 
eter variations, whereas the quantitative identifiability information 
resulting from extended Kalman filtering has been shown to be 
measures of the closeness between the true parameters p* and the 
identified parameters Pre Finally, the complete modeling steps for 
Ocean vehicles using these two techniques and structure selective 
models have been described in detail and several example reduced 
degree of freedom DSRV models were given, 

This section has presented general and specific definitions of 
parametric identification problems and the equations of model refer- 
ence contouring and extended Kalman filtering for the solution of 
these problems. Tne application of these techniques to ocean vehicle 
mathematical modeling and to the equations of Section M has been 
explored, and several of the difficulties involved in this application 
have been discussed, The next section begins the actual use of these 
identification techniques on single degree of freedom equations from 


the DSRV mathematical model, 
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SECTION ¢ 


PARAMETRIC IDENTIFICATION OF OCiAN VEHTICGLl DYNAMICS 





Pl ‘THE NATURE OF OCEAN VEHICLE PARAMEYRIC IDENTIFICATION 
P2 BXAMPLE SINGLE DEGREE OF FREEDOM DSRV EQUATIONS 


P3 MODEL REFERENCE STUDIES OF SINGLE DEGREE OF FREEDOM 
DSRV EQUATIONS 


PY EXTENDED KALMAN FILTERING STUDIES OF SINGLE DEGREE OF 
FREEDOM DSRV EQUATIONS 


"A BAD BEGINNING MAKES A BAD ENDING," EURIPIDES (484-406 B.C,) 


$ 


SECTION M PRESENTED THE STATE SPACE DIFFERENTIAL EQUATIONS FOR’ 
MODELING THE DYNAMIC MOTIONS OF OCEAN VEHICLES, SECTION N THEN 
PRESENTED THE MATHEMATICS FOR IDENTIFYING PARAMETERS IN THE NONLINEAR 
OCEAN VEHICLE EQUATIONS USING MODEL REFERENCE CONTOURING AND EXTENDED 
KALMAN FILTHRING, THIS SECTION DESCRIBES IN DETAIL THE PROCESS OF 
APPLYING THE MODEL REFERENCE AND KALMAN FILTERING TECHNIQUES TO 
OCEAN VEHICLE MODELS, THIS APPLICATION IS DESCRIBED BY USING, AS 
EXAMPLES, THE SINGLE DEGREE OF FRN@DOM DYNAMIC EQUATIONS FOR THE 
DSRV, MANY RESULTS OF COEFFICIENT AND PARAMETER IDENTIFICATIONS BY 
BOTH METHODS ARE PRESENTED AND DISCUSSED, THIS SECTION IS INTENDED 
TO BE AN INTRODUCTION BY EXAMPLE TO THE MORE SIGNIFICANT INDENTIFICA- 


TION STUDIES IN SECTION 6 (C). 


Sitio 








CHAPTEHR Pl 


THE NATURE OF OCEAN VEHICLE PARAMETRIC IDENTIFICATION 

Having established the detailed equation structure for mathemat~ 
ically modeling ocean vehicle dynamics in Section M and the detailed 
equations for identifying parameters in that structure in Section N, 
the foundation has been laid for the development of total ocean 
vehicle mathematical models. Tnis section presents the detailed 
steps in that development in the simplified format of the DSRV single 
degree of freedom equations; and at the same time, this section 
serves as a detailed study of the behavior of the DSRV coefficients 
and parameters in the six uncoupled degrees of freedom. Tne next 
section (D) then presents the structure, simulation set of parameters, 
and digital computer programming description of the DSRV dynamic 
mathematical model in six degrees of freedom with structure selectivity, 
complete coupling, effector equations, and second degree coefficients, 
The following section (C) then applies the identification techniques 
to some selected multiple degree of freedom DSRV models and presents 
qualitative descriptions of the identifiability characteristics of 
selected coefficients and parametcrs, 
Plel OVERALL MODELING STEPS 

The nature and specific characteristics of ocean vehicle 
parametric identification are best described by discussing each of 
the steps in the general mathematical modeling process for such 
vehicles, The system modeler begins with a vehicle or a set of 
vehicle characteristics and proceeds to develop the structure and 
initial parameter values for the mathematical model as in block 2 of 


aly. 





Figure N4.1. ‘The structure may consist of an equation of the forn of 
either equation M2,.30 or equation M3.11 with the effector structure 
having been developed specifically for the given vchicle. The 
effector structure may or may not include the structure and parameters 
of all of the vchicle control systems, depending upon whether or not 
the effects of such control systems can be decoupled from the vehicle 
or effector structure, These beginning structure end parameter 
Specification steps are very important to the overall modeling and 
identification steps which follow, 

Once a set of structural equations and initial parameters have 
been specified, simulation studies may be carricd out. These studics 
consist of Steps Plel through Pl.7 and represent parts or variations 


of the steps in blocks 3 through 10 in Figure N41. 


Overall Modeling Steps 
Step Pl.l Specify eye vehicle 
Step Pl,.2 Design and run a sea trial 
Step Pl,3 Collect input-output data from the sea trial 
Step Pl.4 Process sea trial data to determine vehicle parameters 
Step Pl.5 Decide upon adequacy of the parameters and structure 


Step Pl.6 Decide upon changes to be made in the structure or 
parameters 


Pteperi./ Go to Step Pl.Z2 and continue until satisfactory 
modeling is achieved 


These steps can now be discussed in more dctail relative to the 
Specific problems of ocean vehicle parametric identification rather. 


than the total problem of overall mathematical modeling, 
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Pi.2 SPCIFYING THE VEHICLE: TO BE STUDIED 

famovep Fl4i the vehicle. is specified in detail as to its 
structure and parameters and can be one of the following: the actual 
full-scale vehicle, a physical model of the real vehicle, or a prev- 
iously developed mathematical: model for simulating the real vehicle, 
The full-scale vehicle is the most expensive specification which can 
be made at this point, it is the hardest to vary structure, inputs, 
and parameters upon, but it undoubtedly gives the best or most realistic 
data from a sea trial, 

A physical model of the vehicle may be used at this point and, 
in general, will be less expensive than the full-scale vehicle, For 
overall dynamic mathematical models the physical model will most 
likely need to be self-propelled and will probably need an elaborate 
measurenent system for the acquisition of useful and realistic data 
meem tne model. sea trials, if it is desired to reost emetea TA model 
the effectors or control system structure, then these could be 
physically modeled in this step also. The data acquired from physical 
models can, in general, be expected to be less realistic than that 
obtained from the full scale vehicle, and some procedures for extrapo- 
lating or scaling the results of physical model identifications to the 
full scale vehicle must be developed and employed. One of the main 
advantages of using a physical model is that the vehicle and mathenat~ 
ical structure and the input functions are more easily changed than on 
full scale vehicles so that many more runs may be made with the physical 
model for the same expenditures, 

In the case of the specific studies in this thesis, the DSRV 


nathematical model is specified as the vehicle in this step. In 
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generel whenever extensive identifiability stydies are to be made 
in order for the system modeler to increase his overall understanding 
of the specified structure, the mathematical model is used to 
Simulate the vehicle in Step Pl.l. When structure selectively 
programmed for solution on a digital computer, the mathematical model 
is generally the least expensive and the most flexible way of specify-~ 
ing the vehicle and of actually making simulated sea trial maneuvers, 
The main disacvantage of a simulated model is that the data generated 
may be far different from the real vehicle behavior; however, if the 
initial structure of the model has been properly specified, the 
primary behavior difference will be due to different parameters in 
tie real vehicle than in the simulation. If identifiability studies 
on simulated vehicles show that the parameters are identifiable, then 
later real vehicle data nay be analyzed and the correct paraneters 
found by identification, If the parameters are not identifiable, 
their input or structural variations may be indicated along with 
further simulation studies. | 
Pl.e3 THE SEA TRIAT 

The overall characteristics of the sea trial in Step Pl.2 will, 
of course, depend upon the vehicle specified in Step Pl.l. The primary 
consideration in designing a sea trial to be used in sophisticated 
model parametric identification is the fact that the mathematical 
model must be decoupled or broken down into manageable sub-models, 
Parameters are, in general, only identifiable if they are in some way 
excited by the vehicle effectors or are in some manner coupled into 
the vehicle equations of motion for a specific maneuver, Thus, the 


sea trial maneuvers must be designed to excite specific parameters of 
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interest, and the model structure must be selected specifically for 
the pertinent effectors, inputs, degrees of freedom, and parameters 
being utilized in order to have any chance of identifying the true 
parameters from noisy data, As more knowledge is gained concerning 
parameter identifiability, and as more confidence is gained in the 
values of the parameters ; then more sophisticated models and maneuvers 
are employed. In this manner the system modeler “bootstraps" his 

way upward in complexity, understanding, and accuracy until the full- 
scale vehicle is adequately modeled, 

For prelininary identifiability studies the sea trial should be 
divided into blocks of time during which specific inputs and selected 
degree of freedom models are used, The data generated during pret 
blocks is then used in the model reference contouring studies with a 
model of the same degrees of freedom and with only the parameters of 
interest being varied. As an example of the block Sueaaere for a 
sea trial, Figure Pl.1l shows several DSRV sea trial blocks for the 
Simulated vehicle using some of the medels in Figure N4.1, These 
blocks need not be run in this order, and they need not be run all at 
once, especially in the case of a simulated vehicle. For other types 
of vehicles the decouplings to single and double degree of freedom 
models may or may not give valuable information relative to parameter 
i@entifiability. 

Once the sea trial blocks have been specified, then the inputs 
to the vehicle may be designed either as a set of maneuvers for the 
real vehicle or its physical model, or as a set of mathematical 
input functions for the simulated vehicle. The primary consideration 


in specifying an input for the purpose of identifying a parameter is 
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Block 1 Block 2 
| Sucge (u) model + Suay (v) model 
Le : >| it >t, > 


Propellor input, Identify 


ie and Propellor thrust 


Horizontal thrusters input, 


Identify Xv and H-Thruster 


coefficient thruster coefficient 
Block 3 Block 4 
Heave (7%) mode) pits Roll model Plt 6 
: ly 


Vertical thrusters input, 
Identify —_ and V-Thruster 


thrust coefficient 


Block 5 


Propellor input, Identify 
Kop and FPropellor torque 


coeffici.ent 


Block 6 


Pitch model be eS 6 


Vertical thrusters input, 
Identify Mog and V-Thruster 
moment coefficient, 


Pree 15 in secondary drag 


Block 14+ 


Surge, roll (u,p) model 


Horizontal thrusters input, 
Identify ie and H-Thruster 
moment coefficient, 


N. =C in secondary drag 
rr ~16 Satie 


Block 1345 


Vertical plane with roll 


, model (u, Wy, Pp, q) | 
——— s te 


Propellor input, Identify 


X é 
=? Kop’ eet and. 


propellor coefficients 


Propellor, shroud inputs, 
Identify all primary and 
cross-coupled vehicle coeff., 


propellor and shroud coeff. 


Figure Pl.] EXAMPLE SEA TRIAL BLOCKS FOR DSRY 
Ei yccom 





that the input should excite the system dynamics involving that. 
parameter as much as possible, In the literature (A~13) (A-4) (A-16) 
@ee,, oh input of this type is designated "persistently exciting," 
has a precise definition, and is show to be a necessary type of 
input for soyewi cases of linear system parametric identification. 
For nonlinear systems this a1] translates someuhat imprecisely as an 
input function whose Fouricr spectrum contains ali frequencies, 
especially those frequencies et or near the naturai frequencies 
influenced by the parameter of interest. Step functions, impuise 
functions, and white noise are examples of this type of imput, whereas 
Single and multiple frequency sinusoidai functions are not, 

Specifying proper inputs is extremely important to the process 
of parametric identification, The kinds of inputs which provide the 
best identifiability for parameters of interest may be determined 
from Simulated vehicle studies and model reference contouring. in 
general, the proper input specification is more critical to the 
extended Kelman filtering technigue than to model reference contouring. 
Nor @ given ocean vehicle and its SPeaetiis' the kinds of itiputs which 
may be used will be constrained by the physical limitations of the 
vehicle, its operators, and its effectors and by sea states, Thus, inputs 
designed for simulated vehicle studies should reflect these limitations, 
Ple4 INPUT-OUTPUT DATA COLLECTION 

Once the sea trial blocks and input functions have deen designated, 
the actual sea trial may be eonaneeed, with the zeal vehicle, its 
physical model, or its mathematical mode]; and the input-output data 


(u, z) for the paranetric identification processes may be ccllectedcd, 








fhe sea trial data for the real vehicle or for its physical model is 
usually collected by some form of measurement system, It is important 
that the structure of this measurement system be specified (Chapter 
M3.1) and that the same structure be used in the simulated sea trials 
and identifiability studies as is used in the real vehicle or 

physical model sea trials, 

The parameters for the measurement system may theoretically be 
identified in the same process as the sea trial parameters. However, 
if it is at all possible to treat the measuring process as a different 
system and to identify its parameters separately, then some effort 
should be spent in this form of parameter decoupling. For some 
vehicles it may be possible to transform the sea trial data into a 
form directly usable by the parameter identification techniques 
Without affecting the identification process or the true values of 
the parameters, In this case the measurement system would not have 
to be included in the simulation studies, 

When sea trials are conducted with fuil scale vehicles or with 
physical models, the input-output data is usually recorded on digital 
or analog magnetic ee For the case of the simulated vehicle sea 
trial this data nay memeeeorded on magnetic tape, punched cards, 
punched paper tape, magnetic disc, high speed printer, or many other 
devices, In either case axe must be taken to insure that the 
recorded input~output data is compatible with the inputs to the 
“jdentification processes and with the conputer programs used. 

Pl.5 PROCESSING THE SEA TRIAL DATA 
In Step Pl.4 the sea trial data is used as the input data for | 


either the extended Kalman filtering or the model reference contouring 
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techniques. When the digital computer programs are set up to include 
the model and measurement structure and the initial or “best guess" 
values of the vehicle parameters, then the sea trial data can be 
processed to determine the parameters which were used in its genera- 
tion. Both of the identification techniques utilize multiple passes 
over the sea trial data, The model reference contours are generated 
by making many simulated sea trials with different parameter values 
and comparing the outputs at each pass with the sea trial data, 

The extended Kalman filter may be run many times over the same sea 
trial data by using the previous~-pass best estimates of the states 
and error covariances as the initial states and error covariances for 
the next pass. The outputs of these processes are contours, ae 
and numerical values which may be analyzed by the system modeler, 
Ple6 ANALYZING IDENTIFICATION RESULTS 

The results of the identification processes are analyzed in 

teps Pl.5, Pl.6, and Pl.7 by the system modeler to determine whether 
or not the parameters have been identified, whether or not the 
identified parameters adequately model ne system, and what changes 
ere to be made in the modeling and identification processes before 
more sea trial runs are made, The determination as to whether the 
parameters have or have not been identified is made based upon the 
System modeler’s understanding of the basic characteristics of the 
vehicle behavior and upon his knowledge of the identifiability 
characteristics of the specific parameters of interest, Whether or not 
the identified parameters adequately model the vehicle is determined 
primarily by the cost function or closeness value for that set of 


parameters and that set of maneuvers and by the system modeler's 
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eriterion of that value of closeness for which he may call the vehicle 
Mecately modeled, The cnanges which must be made in the modeling 
and identification processes are in many cases indicated by the 
characteristics of the output contours and plots as interpreted by 
the system modeler, Many of the detailed considerations for analyzing 
identification results are presented by example in the DSRV studies 
Seetnis section and of Section C. 

This chapter has presented an overall view of the steps used 
in developing mathematical models for ocean vehicles, The considera~ 
tions used by the system modeler for specifying the vehicle, breaking 
the sea trial into blocks, designing the input functions, and 
utilizing and interpreting results from the identification techniques 
have been briefly described, The next chapter begins the detailed 
studies of the DSRV by specifying its single degree of freedem 
equations and conducting preliminary analytical analyses of their 


behavior. 
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CHAPTER P2 


EXAMPLE SINGLE DEGREE OF FREEDOM DSRV_ EQUATIONS 

When five of the six degrees of freedom in the mathematical 
models of Section M are set Me their equilibrium values, the resulting 
six separate models are called the Single degree of freedom equations 
for the vehicle. These separate equations no longer truely model the 
behavior of the vehicle, but a great deal of information about the 
vehicle behavior may be ecquired from studying them. This cnapter 
presents the detailed DSRV single degree of freedom equations and 
many of the basic considerations which may be applied to their study, 
P2e1 DSRV SINGLE DEGREE OF FREEDOM EQUATION STRUCTURE AND PARAMETERS 

When any combination of five of the six primary states (u, v, ¥, 
Dy oO, ©) are set to the equilibrium values 0.0, the resulting equation 
fomm is essentially the same fer all cases of the DSRV and is given by 


equation P2.).. For the case in which positive velocities are used, 
=ax [xi + bu [ul  & Pea 


this equation reduces to equation F2.2, Note that the uv in equations 


& = ax? + du? | P2.2 


P2,] and P2.2 is the appropriate propellor or thruster revolutions 

per second and not the vehicle surge velocity and that the gravity 

terms in all of these equations have been set to zero, The essential 
Structure of equation F2.1 is that of an object of unit mass being 
driven through a fluid with absolute-square drag behavior (Chapter M3. 3). 


A more detailed surge equation with ux coupling is given by equation D313. 


pelle pine 


The specific DSRV cheracteristics for these six single degree 
oi freedom models are presented in Table PZ,j3, ‘Tne values of the 
parameters a and b in Table P2.1 are those values used in the sea 
trial data generation and the values of u (inputs) represent maxi-~ 
mum values of these particular effectors used in the sea trial, 

The steady state value of x is calculated by solving equation P2,.3 
which represents the equilibrium solution to equation P2.2 when the 


inputs are set to their constant step-function values. 


Oe- a x?_ seb us P2533 
The value of an approximate equation time constant “Y may be 
derived by linearizing equation P2.1, with the input u set at its 
step-function value using the points (x, x) = (0, x.) and (x, x) = 
(buju], 0). The value of the time constant for the linearized system 
becones max.) and the linearized equation is given by equation 


P2.4. The value of 64 is somewhat arbitrarily chosen as one-tenth of 


Scr x 4 DU P26 


SS 


oe 
| 


a time constant, Tne large number of trajectory calculations in 
model reference contouring requires that the time steps be as large 
as possible to limit computation time, 
P2.2 EXAMPLE OF AN EXTENDED SINGLE DEGREE OF FREEDOM EQUATION 

The equation presented in equation P2.]. is the simplest structure 
possible which exhibits the essential motion benavior of the DSRV, 
There are numerous extensions, still in a single degree of freedon, 
which can be made and studied regarding this structure, An exanple 


is the DSRV roll. equation which is extended to include the gravity ~ 
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Table P2.1 CHARACTERISTICS OF DSRY SINGLE DEGREE OF FREEDOM MODELS | 
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and angular effects, When the vehicle angles are inciuded as 

State variables, then the DSRV roll equation appears as the two- 
state system given hy equations F2.5 and P2,.6, If these states are 
combined, the second-order nonlinear differential equation F2,7 in 


the roll angle Y results (for a simplified, 2~parameter system). 


g= fp Paeo 
peap | P| + C oe - bu [uw | ARES 
P-a ypl|¢| +c siny=du |u| P2.7 


Where: c= 0.444 for DSRV 

The system in the above equations is a perfect example of what 
is calied Newtonian Damping. The characteristics of this nonlinear 
differential equaticn are discussed in detail by Struble (S-8, p. 20), 
where the properties of solution existence, uniqueness, continuity, 
and stability are all shown to be valid for this set of equations, 
This extended single degree of freedom model is presented to show 
some of the considerations which might be necessary in studying the 
Single degree of freedom equations of a general ocean vehicie, The 
parameters 2, b, and c could now be studied for their identifiability 
characteristics using model reference contouring end could also be 
identified using the extended Kalman filtering technique. 

If the system modeler can show that the single degree of frecdom 
equations for his specific ocean vehicle are well behaved in a mathe- 
matical sense, then he has some degree of confidence in the proper 


behavior of multiple degree of freecom models. Precise generalizations 
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cannot be made in this respect because of the nonlinear nature of 
the equations, but the verification of the analytical properties of 
these multiple degree of freedom models is usually much more diffi- 
cult than for the single degree of freedom equations, 

The homogeneous portion of equation P2,2 is a subcase (a = a,) 
of the more general homogeneous nonlinear differential equation P2,.8, 


The general solution to this equation is given by equation P2.9, and 


the more specialized solution for a) = O is given by equation P2.10, 


Xf: a, X + a, x? P28 

Mt ) = x 

(t)) =x, pet.) F269 
L+ x, 2. (1-021 (tte) Ya, 

x(t) = Xo for a,=0 F2.10 


We ey ae (t-t.) 


The fact that the derivative dX/dx is continuous means that equation 
P2,.8 satisfies the Lipschitz condition (S-8) (H-7). This guarantees 
that a solution exists which is unique and continuous (Equation P2.9), 
The equilibrium solutions to equation P2,8 are x = 0 and x = ~3,/a5¢ 
For the cases in which a, < 0, the equilibrium solution x = 0 is 
stable, and the equilibrium solution x = ~a,/a, is unstable. 

Another analytical consideration is one which applies to the 
nonhomogeneous equation P2.2 and concerns the nonlinear observability 
of this equation when expressed as a state estimation problem. This 
test is discussed in Chapter M3-1, is developed in detail by 


Schoenwandt (S-5), and is applied to equation P2.2 in Appendix All. 
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The results in Appendix Ail. show that the nonlinear state 
estimation problem for equation P2.2 is observable and, therefore, 
thet the states may be estimated based upon input-output information, 
This is very important information relative to the utilization of 
this equation in an extended Kalman filter, The nonlinear observ 
ability test also gives useful information concerning certain 
characteristics which the input function must have in order that 
observability be possible. In tne case of equation b2,2, the input 
cannot be zero or the steady-state step value of u for the states to 
be observable. 

As one might expect, the application of the nonlinear observabil- 
ity criterion to any but the simplest equations is extremely difficult. 
When applicable, however, the information gained relative to the 
observability of the system and to the characteristics of the input 
is very useful in modeling and identification studies, 

PZ. 4 STOCHASTIC SINGLE DEGREE OF FREEDOM MODELS 

The single degree of freedom models discussed thus far in this 
chapter have been deterministic and have contained none of the 
structural, input, and measurement uncertainties discussed in Chapter 
M4. The structure of the stochastic models for the DSRV in single 


degrees of freedom is given by equations P2.11 and P2.12. Note that 


Se 
il 


Se | ea P2.11 


Z=2=X+eV PZah2 


the w and v in these equations represent zero mean gaussian white 


process and measurement noises and not the heave and sway velocities 
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of the venicle. Equations P2.li & Pe.j2 are solved discretely using Vy, & Wn 

The process noise w appears to affect the system in a completely 
lineaxy fashion, but in actuality, the fact that the state variable 
hers squared ai each time increment causes the process noise to enter 
the system nonlinearly. Tne measurement noise v enters the measure-~ 
ments of tne states in a linear fasnion: but when the model. reference 
cost function is calculated, the v noise is essentially squared at 
each time increment. The fact that both of these zero-mean gaussian 
processes are squared can cause biases in both the system outputs 
and the identification technique ovtputs. Tne reason for this is 
that the are or a zero-mean gaussian random variable is no longer 
of zero mean as shown in Appendix A10. 


in later studies of single and multiple degree of freedom DSRV 


= 


parameters, the amounts of Wend V noises arc expressed as percentage 
values Zw and %v, The process noise percentage %7 means that the 
standard deviation (c,, = JQ) of wis that percentage of the maximun 
Value of x in equation P2.11 for a step function maneuver ue The 
measurement noise percentage %v means that the standard deviation 

(c, = JR) of vis that percentage of the maximum value of x being 
measured in equation P2,12 for a step function maneuver u. mese are 
Sonvenient cefinitions for simvulaticn studies, but they must be 
interpreted properly for a given maneuver, If x or x is at a small 
value for most of the maneuver and then essumes its maximum value only 
for a short period during the maneuver, then the associated w or v 
noise has a much greater effect upon the overall system uncertainty 


then it does if x or x is at its ma “wm value for most cf the maneuver, 
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Tis chapter has presented the structure, numerical values of 


the parameters, and several analytical considerations for the DSRV 
single degree of freedom equations with and without process and 
measurement noises, ‘These equations may now be used to simulate sca 
trials for the simulated vehicle input-output data, This data may 
then be processed for paraincter identifiability studies using model 
reference contouring in the next chapter (P3) or for actual parameter 


identifications using extended Kalman filtering in Chapter P4, 
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CHAPTER P3 


MODEL REFERENCE STUDIES OF SINGLE DEGREE OF FREEDOM DSRV EQUATIONS 

This chapter presents an in-depth study of the DSRV surge 
equation using model reference contouring and varying the types of 
inputs, the amount of process noise w, and the amount of measurement 
noise v. The next chapter presents the results of similar studies, 
With many of the same inputs and noise levels as this chapter, using 
extended Kalman filtering. In this manner the detailed application 
of these techniques to simple ocean vehicle models is explained, and 
the surge parameters for the DSRV are examined to determine their 
Pientitiability characteristics relative to these two techniques, 
different inputs, end different noise levels, 

The exact numerical values of the two DSRV surge parameters and 
the specific vehicle and model equations to be studied in this chapter 
are presented in Figure P3.1. The GRRE should remember the values 
py = ~16.7 and pS = 755. because these are the "true" or optinal 
parameters used throughout this chapter and the next, The results 
of the identification studies are classificd and presented in this 
Chapter by the propellor input function types: step, staircase, 
crashback full astern, impulse, and sinusoidal of different periods. 
One version of the Fortran IV computer prograin is presented in 
Appendix Al2, and the contouring and plotting subroutines used are 
presented in Appendix A5-. 

P3.1 MODEL REFERENCE SURGE CONTOURS USING A STEP FUNCTION INPUT 

Given an ocean vehicle to test, the most obvious thing to do 


is to “turn it on and see what happens." Let the DSRV propellor 
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Vehicle (Simplified es a 


ew 


2 parameter system, see Equation D3.13) 


; DSRV _ | _+%> x 


“16.7 x |x[+ 755. u jul + 4 





ra 
“~~ 
cr 
Oo 
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ti 
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numerically: 





l} 


S07. x 
Z=x+v 4 solved discretely for 2, = 2(t,) 
Where: Pte se ~16.7 = Surge Drag Coefficient 
PS 3 oe = 755. = Propellor Thrust Coefficient 
n= 4507. slugs = mass of the DSRV 
w= gaussian white noise = N (0,Q); discrete 
V = gaussian white noise = N (0,R); discrete 


x = surge velocity in ft/sec 


u = propellor rotation in rev/sec 


nx = Py x |x|] + Po v jul 
a x(t) = Q 3; solved discretely at times th 
woere : Ds is in the domain [p¥ = 0 = iy eH + d|, 


with 6 ~ > p* 
i 
In other words, vary Ps approxinately + 50% of pe 


Figure P3.1 DSRV SURGE EQUATIONS AND PARAMETER VALUES 
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input u(t) be given by the step function in Figure P3,2 for the sea 
trial length of 470 seconds, With this input and the conputer 


Peogtam or Appendix Al2 a simulated wea trial may be computea for 
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the DSRV in surge. A plot of this simulated sea trial without any 
Bncess or measurement noise is computed by SUBROUTINE FLOT in 
Appendix A5 and shown in Figure P3.3. Note that the plot is read 
using the left side as the time axis and placing the origin in the 
upper left corner of Figure P3,3. A similar plot for the step func- 
tion input with 10% v and 10% w noises (See Chapter P2.44) is presented 


in Figure P3.4, 


u, rps 


7. SCC 


0 1470 


Figure P3.2 PROPHLLOR STEP FUNCTION INPUT 
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With a step function input the DSRV accelerates from 0 to 6.7 
ft/sec exponentially in about 90 seconds for a drag coefficient of 
-16,7 and a propellor coefficient of 755. If the mathematical model 
is now used with the same input and different parameters, a mathemat~ 
ical model sea trial pan Ge generatec, Jf the output of this sea 
trial is subtracted from the vehicie sea trial at each instant of 
time, and the result is squared and summed over the sea trial; then 
the resulting value C(p) (See Chapter N2) is generated and represents 
the closeness of this model to the vehicle over that sea trial, If 
these C(p) values are generated for many different values of the 


parameters, then the resulting set of C(p)'s may be contoured to 
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Peete F5.3 “PLOT OF DSRV SURGE VELOCITY FOR A STEP 
FUNCTION INPUT AND NO NOIS! 
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determine the identifiability characteristics of pe The contours 


for the step function input of Figure P3.2 and for no noise using 


the sea trial data in Figure P3,3 is presented in Figures P3,5 and 


P3.6 
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Figure P3.5 NUMERICAL VALUES OF CONTOURS IN FIGURE P3.6 


The detailed numerical values are automatically printed out by 
SUBROUTINE CONTUR in Appendix A5 whenever a contour is generated, 
In Figure P3,5 the X-RANGE corresponds to the range of Pi» and the 
Y-RANGE corresponds to the range of Doe These detailed values of 
Py and Po are printed along the edges of the contour with X running 
vertically and Y horizontally in Figure P3.6, The horizontal values 
of Po are set such that the last number in the exponential corres- 
ponds to the numerical value for that * location on the axis. At 
the top of the contour, the left, center, and right values of PS are 
@iven with greater accuracy than the axis values, The Z-DOMAIN values 
correspond to the minimum and maximum values of C(p) over the contour, 
The contours in Figure P3.6 run from the minimum or 1-value to the 
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Figure P3.6 SURGE, NO NOISE, STEP FUNCTION CONTOURS 
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naximum or M-value in Linear increnents of DZ. The Z-DOMAINS 
descriptions in Figure P3.5 correspond to the 21 numbers and letters 
1 through M usea in the contour, 

The studies in this thesis required that large numbers of plots 
and contours be generated, ‘There are, of course, much better 
methods for generating contours and plots than the printer method 
used here. However, the miinon!s experience has been that the sub- 
routines of Appendix A5 provide a cost savings factor of approximately 
10 when compared to the SC4020 or CALCOMP, Each of the contours and 
plots in this thesis along with many others , in this thesis were 
generated at a cost well under 54 eache The author hopes that the 
reader will not experience too much conceptual or visual trouble 
interpreting these plots and contours, 

The reader can see from P3.6 that for a step function input 
the cost function looks somewhat like a “trougn" running Givard fron 
left to right. Tne contours here look like those of contour 9 in 


Figure Nit.4, and show that for a step function input Py and p, are 


a 


almost linearly dependent in the form of equation P3,1, The reason 
Po ss =l{O Py + 88 Pea 


for this behavior is that the input (step) function causes x to be 
nearly zero for most of the sea trial at the steady-state value of 
x= 6.7 ft/sec. Substituting these values into the vehicle equation 


of Figure P3.) gives equaticns P3.2 and P3.3. The difference between 


O= p) (6.7)? Pal, G2 P3.2 
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equation P3.1 and P3.3 is caused by the dynamics of the vehicle in 
mie first 90 seconds of the sea trial in Figure P3.3 and is the only 
reason that the parameters are identifiable in Figure P3.6,. 

A better insight into the shape of the contours in Figure P3.6 
may be gained by plotting 5 equally spaced vcrtical slices of these 
contours as in Figure P3.7. Here the numbers 1 through 5 represent 
these vertical slices running from the left side to the right side of 
Figure P3.6, The most obvious characteristic of these contours is 
the very flat minimun along the bottom of the trough. In the case 
of this differential equation, the flatness is caused by the fact 
that the input does not excite the dynamic behavior of the vehicle 
for much of the sea trial. This means either that the parameters 
are not easily identified in the basic model structure or that the ’ 
input function is not exciting the vehicle dynamics enough to identify 
the parameters. It is highly probable that snall amounts of noise 
introduced into the vehicle will obscure the parameters and prohibit 
their identification, 

When the same contour calculation steps are used with the 10% w 
and 10% v noisy sea trial data in Figure P3.4, the resulting contour 
is shown in Figures P3.8 and P3.9. This contour has cssentially the 
same shape as the noiseless one in Figure P3.6, but thcre are some 
very important differcnces, The most significant difference is that 
the minimum values of the noisy contour are shifted away from the 
known “true" values of -16.7 and 755 to the values of -14,9 and 700. 
This shift is most likely due to the biascs generated by the two noise 
processes and has the effect of making the parameters unidentifiable 
if 85% or better accuracy is required. In addition, if 85% accuracy 
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Figure P3,8 NUMERICAL VALUES OF CONTOURS IN FIGURE P3.9 


is acceptable, then the closeness of the model to the vehicle is 
C(p*) = 273. for the noisy case whereas it was C(p*) = 0. for the 
noiseless case, compared to a maximum value of over 4000 in both casese 
Thus, elthough the trough has remained essentially the same shape, 
the bottom has been raised significantly enough to sdnewhaboveemme 
the true values of the parameters, | 

The contour in Figure P3.9 shows that v and w noises greatly 
affect the identifiability of the parameters; the question then 
becomes "For a step function input, which type of noise has the most 
Significant effect on identifiability?" It must be kept in mind 
throughout this analysis that the primary effect of the v and w 
noises is to make the optimum p and the minimum cost function vaives 
C(p*) into random variables of which these contours are samples. 
Contours were also generated for the cases (v=0, w=10%) and (v=10%, 


w=0), and the essential results of those contours along with the tro 
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previcusly discussed are presented in Table P3.1. This table shows 
that both process and measurement noises have significant effects 
upon the identifiability characteristics of the parameters, but that 


vy noise has more significance for C(p*) than w noise. 





Step Input pf (16.7) pe 755) | CORT Cc max | Comments 


a= aS ee! | Ae Se 


v=0, w=0 ~16.7 (ew 0.0 | 4021. | Trough shape; 
Fige N4,4 #9 


v=0, w=10% “17.9 825 1346 +'3902. ob Same 
v=10%, w=0 ~1769 805 305.0 | 4390. Same 


=10%, w=:10% -14,9 700 27260. || ae: Same 





Table P3.1 SURGH EQUATION IDENTIFIABILITY CHARACTERISTICS 
FOR A STEP INPUT 


The detailed plots and contours for the step function input 
have been presented here to show the reader how the previous identi-~ 
fiability considerations and the numerical values in Table P3.1 were 
arrived at. For the remainder of the studies in this chapter, only 
the basic noiseless plots and contours will be Sees ner The noisy 
plots and contours will be described in tables of the same form as 
Table P3.1- 
P3e2 MODEL REFERENCE SURGE CONTOURS USING A STAIRCASE FUNCTION INPUT 

The step function input previously discussed only excited the 
dynamics of the vehicle for 90 seconds of the 470 second sea trial, 
The staircase function input in Figure P3.10 excites vehicle dynamics 
Over most of the sea trial duration and proves to be a much better 
identification input than the step function. The DSRV propellor 


takes about 3 seconds to come up to speed (B-9), and so the step and 


~1L74- 





staircase function inputs are realistic from the standpoint of the 9 
second vehicle time constant and the 470 second sea trial, 
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Figure P3,10 FROPELLOR STAIRCASE FUNCTION INPUT 





The resulting noiseless sea trial data is given by Figure. F3.11 


and the noiseless contours are presented in Figures P3,.12 and P3.13, 
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Figuce P3.12 NUMERICAL VALUES OF CONTOURS JN FIGURE P3.13 
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Tne contours in Figure P3,13 show a much more clearly defined optimun 
than in the case of the step function input of Figure P3.6, The 
Staircase input is designed to specifically excite both Py and Poe 
The first two steps in the propellor excite the equation through Po 
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up to 200 seconds into the sea trial; and the propellor shutoff at 

200 Pe chds causes only Py + the drag coefficient to be in the dynamic 

equation of the vehicle until the end of the sea trial at 470 seconds. 
A large number of identifiability studies for different noise 

combinations were conducted with the staircase input, and the essen- 

tial results are shown in Table P3.2. There are several conclusions 

which can be drawn from this table relative to the identifiability 

characteristics of Py and Poe In the first place, the parameters 

are essentially unidentifiable (to + 50%) for v or w greater than 

20%. ‘This says that if the structure or measurements are 20% 


erroneous, then the parameters cannot be identified to within + 50% 
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Table 23.2 SURGE RQUATION IDENTIFIABILITY CHARACTERISTICS 


FOR A STAIRCASE INPUT. 
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Table P3.2 (Contd.) SURGE EQUATION IDENTIFJABILITY CHARACTERISTICS 
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Table P3.2 (Contd, ) SURGE EQUATION IDENTIFIABILITY CHARACTERISTICS 
FOR A STAIRCASE INPUT 





KR = Relative Minimum 


accuracy using model reference contouring. This gives some indication 
as to the importance of proper model structure and measurements in 
System identification. Secondly, the larger number of results in 
Table P3.2 than in Table P3.1 gives some indication of the randomness 


of p* and C (p*) as the noise levels are increased, Thirdly, it is 
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obvious from Table P3.2 that the model reference contouring method 
is not well suited to extremcly noisy (> 30%) systems because the 
contours, actually random variables, are only seen at one instant 
of time and cannot be averaged to get some "mean" of behavior 
Finally, this table shows that measurement noise v has a much more 
significant effect upon the value C (p*) and the identifiability of 
the parameters than does the process noise w in this case, 


P3.3 MODEL REFERENCE SURGE CONTOURS USING A CRASHBACK FULL ASTERN 
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Whereas the staircase input was designed to somewhat evenly 
excite both the Py and Po dynamics, tne crashback full astern input 
Memeesiened to excite the entire equation with a large transient at 
Maercenter of the sea trial. This input is shown in Figure P3,14 


and the noiseless sea trial data resulting from it is shown in Figure 


Bey l5. 
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‘Since more vehicle dynamic motions are excited by this input than 
either the staircase or the step functions, the contours can be expected 
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to have a more clearly defined optimum. This is precisely the case 


as seen in Figures P3.16 and P3,17. The contours in this case are "bowl" 
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Figure P3.16 NUMERICAL VALUES OF CONTOURS IN FIGURE P3,17 ° 


shaped with a fairly flat bottom but a cleariy defined minimun. 


There is no longer any evidence of the partially lineazr dependence 


which was found in the case of the step function input, Several of 


meeenorse behavior characteristics for the crashback full astern 


input are presented in Table P3.3. The numbers in this table 


Crashback Input 
v=0, We 


v=10% ’ w=0 
V=10%, w=10% 


Table P3.3 SURGE EQUATION IDENTIFIABILITY CHARACTERISTICS FOR 
A A CRASHBACK FULL As 1 ASTERN AOeT 
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Figure P3.17 SURGE, NO NOISE, CRASHBACK FULL ASTERN CONTOURS 
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indicate approximately that 10% noises still permit parameter identi- 
fications to within about 10% accuracy. ‘The fact that the contours 
remain bowl shaped even when noises are added indicates that this 
input function is a good one for identifying these parameters using 
model reference contouring. 


P3.4 MODEL REFERENCE SURGE CONTOURS USING A SIMULATED IMPULSE 
FUNCTION INPUT eel aes 


An impulse function is an unrealistic input for the DSRV 
propellor but such a function may be simulated by the input function 


in Figure P3.18. This input function excites the dynamics of Po very 
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Figure P3,18 SIMULATED IMPULSE INPUT FUNCTION 


strongly, but only for the first 100 seconds of the sea trial. The 
dynamics associated with Py are in effect for the entire sea trial. 
The sea trial which results from the simulated impulse function 
input is shown in Figure P3,19, and the resulting model reference 
contours are shown in Figures P3,20 and P3,.21. Several of the noise 


behavior characteristics for this input function are shown in Table Page 
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Figure P3.20 NUMERICAL VALUES FOR FIGURE P3,21 





Comments 


v=0, w=0 Bowl shaped, 
bottom 


v=0, w=10% 
=10%, w=0 


=10%, w=10% 


Table P3,4 
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The contour shapes in Figure P3,21 are quite similar to those for 
the crashback full astern input in Figure P3.17. This indicates that 
the amount of dynamic behavior excited in each case is about the same 
and that the impulse function is an input which greatly facilitates 
the identification of a) and Pye The noise behavior of this system 
for an impul.se function is seen to be mucn better than that for a 
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erashback full astern input. ‘This is due partly to the fact that it 
is a Pot ber type of input function and partly to the fact that the 
large amplitude Be x in Figure P3.19 makes the 10% step noise 
factors behave effectively as much lower percentage noises, 
P35 MODI REPERENCE SURGE CONTOURS USING SINUSOTDAL INPUT FUNCTIONS 
_ The previous inputs examined using model reference contouring 

for the DSRV surge equation have all had discontinuous time deriva- 
tives and have been of a “persistently exciting" (A-13) nature. A 
single frequency sinusoidal input function has neither of these char-~ 
Beteristics, but it is shown to be a valid input for the identifica-~ 
tion of parameters Py and Po when it has the proper period of 
oscillation. A too-long period of oscillation does not sufficiently 
excite the dynamic behavior of the equation to permit identification, 
and a too-short period of oscillation does not permit the surge 
velocity x to reach enough amplitude to override the 10% step noises 
or to permit identification. The sinusoidal inputs used in these tests 

have amplitudes of 1.414 rps. and periods of 100, 150, 300, and 500 
seconds, 

A Sinusoidal input function enters the surge equations in 

Figure P3.1 as a constant value minus a cosine function of twice the 
frequency because of the trigonometric relationship in equetion P3.4,. 


With a step (?3.28 lower part) function input the system takes about 


Sin® 6t = (1 - cos 26t)/2 P3044 


Q@=2n/TP ; TP = Period P3.5 


80 seconds to approach steady state in Figure P3.3, therefore, it 


-189- 


m7 





PT. 0 






: = Mooe5 * ITNCRENENT cs Yel44i8GLE ©] 
Meme cco OS9E OL Uemoco oo: UD Me (GBS CLGE 
Meee ool Cl —0,64—F CO Oo2lE Sl Ged55E Bi Go 79k ie 


: ei: oA oh 
Dee eo” e©s0S”~009%s"a008* cn co%*p000*u9 05 Foot 0° creme. > if 


i “ 


s ~ 


_ 
Sst -wW 
~ ay 


} 


‘& 


— 
4s 


7 x 


— 
bar bel 


baa 


j = 
< 


J Figure P3,22 


SURGE VELOCITY, SINUSOIDAL 


—— 


INPUT, PERIOD 150 SBCONDS, 
NO NOIS# 





] 0 


.. MEE ooo Ko e oot eco ot nv0c0*%e p00Tev00*%eo 20% 6 ho > © om e™ 
Meee O8S5E Cl -O.E4E CO Oo21F D1 92508 11 OL 79E 8) 


=O = 





g 


“wee! 








might be intuitively expected that the period of the sinusoidal 
function which would continually excite the dynamics of the Surge 
equation would be about 160 seconds, Indeed, of the four different 
period sinusoidals used in these studies, the 150 second sinusoidal 
input yields the best identifiability for both parameters Py and Pos 

The sea trial data resulting from the use of a 150 second sinu- 
soidal input is plotted in Figure P3,22, 4 close look at this figure 
shows that the output function is not exactly sinusoidal in shape 
but is similar to a combination of two sin® terms as in equation 
fmeyeone tor xX > 0 and one for x <0. The sea trial data plots for 
100, 300, and 500 second Sinusoidel function inputs are of Prope 
mately the same snape as Figure P3.22 with their corresponding periods 
and are not shown here. 

The model reference contours for sinusoidal inputs of periods 
100, 150, 300, and 500 seconds are presented in Figures F3.24 through 
P3.27 respectively. Tne detailed contour parameters for the 150 
second sinusoidal input are presented in Figure P3,23. The parameters 
for the contours using the other sinusoidal inputs are not shown in 
detail, but their essential characteristics appear in later noise 
characteristics tables. 
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The sinusoidal input contours in Figures P3.24 through P3,27 
show that as the period of the sinusoid is increased (frequency 
decreased), parameter p, becomes more identifiable and parameter Pe 
becomes less identifiable. The reason for this is that at the shorter 
periods the values of x are smaller, and Py is not as dynamically 
excited as at the longer periods, However, for the 500 second 
period input neither parameter is excited as much dynamically as for 
the 150 second period input, because the system responds fast enough 
to “keep up" with the 500 second period input. The most identifiable 
input of these four periods considering both parameters Py and Po 
is the 150 second period sinusoidal input. 

The noise behavior characteristics of the four different period 
Sinusoidal input functions are shown in fables P3.5 through P3.8, In 
each of these noisy cases, the contours renained essentially the same 
shape as the no~noise versions in Figures P3,2/ through P3.27. The 
most significant fact indicated by the numbers in these tables is 
that 10% noises permit about 10% accuracy identifications, The 
parameter Py is the lesser identifiable, and parameter Po is the more 
identifiable parameter with regard to accuracy. Considering parameter 
identification accuracy, contour shape, and contour min. and max, 
numbers, the 150 second-period sinusoidal input allows the best ident~ 
atication of Py and Po for the four different period sinusoidal inputs, 

In comparing the behavior of the 150 second-period sinusoidal 
input to all other inputs used thus far in this chapter, it is found 
that this sinusoidal input offers the best identifiability for the com~ 
binations of 10% noises used, ‘This is due to the fact that this 


input excites the System at its "natural frequency" and causes the 
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greatest amount of dynamic behavior over the length of the sea trial, 
But, then if the tine parameters had not been known, this "natural 
meency” would not have been known; and the “best" input covld not 
have Been chosen ahead of time. It is for these reasons that 
"persistently exciting" (A-13) inputs must be used to "guarantee" 
identifiability, whereas the sinusoidal input which excites the system 
at its natural frequency provides the best means for identification 


using model reference contouring. 


Sinusoidal 100 sec. p¥(-16.7) p§(755) 


ve), w=-0 
v=0, w=10% 


v=10%, we=:0 


v=10% ys w=] 0% 





Table P3.5 NOIS# BEHAVIOR CHARACTERISTICS FOR A 100’ 


SECOND=PERTOD SINUSOTDAL INPUT 











Sinusoidal 300 sec. C (p*) | C max. 


v=0, w=0 







v=0, w=10% 






v=10%, w=0 


v=10%, w=10% 


Table P3.7 NOISE BEHAVIOR CHARACTERISTICS FOR A 300 


PENDS 1 I LN LPP et RICA TS SLR OE OT tee Cer rE alle 


SECOND-PERTOD SINUSOIDAL I HG Helo 
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Sinusoidal 500 sec. py(~16. Ay pe (755) C (p*) 1 C max. 






a 






v=0, w=0 -16.7 755 0 3096 






v=0, w=10% ~16.4 750 30 | 3974 






v=10% iO “1702 770 303 by m9 





y=10%, w=10% aye? 810 254 | 3834 







Table P3.8 NOISE BEHAVIOR CHARACTERISTICS US FOR A 500 


SECOND-PERIOD S$ SINUSOIDAL INPUT — 






Obst p, (-16.7) Po (755) C (p*) Comments 





0 ~16.7 (55 0 . 1775 |Oblong Bowl, Fig. 
N44, #5 





2 1 16.7 755 0.2 1774 |Figure N44, #5 

3 10 ~16.9 (os nae 1908 {Same as Noe 1 above 

io 100 1967 660 2660 59036 |Flat Bowl,Min, 
Shifted 

5 200 ~2262 560 2922 12360 | Figure N4.4, #7 

6 0 ~16.7 Use 137 1758 |Same as No». 1 above 

‘4 i -16.8 755 Lowi 1780 No. l 

8 10 ~16.8 70 33 1846 No. 

9 100 | +22,2 800 3407 | 6647 Noe 

10 200} -10.7 800 4034 | 6397 No. 

i O}| 16.7 760 282 | 2027 No. 

}2 3) ~18,2 770 229 2073 Noe 
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-11.7 
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DD? 
555 
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850 
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700 
1050 
600 
560 
550 
1050 


620 


830 
860 
650 
770 
800 
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680 
1030 
660 
580 
660 


310 
2009 
4078 

205 30 
21460 


29680 


11.4200 


97840 


13.9500 
106000 


102700 


16520 
17690 
307/40 
24200 
25570 
Wes 
904 
ZZ 
V5 Ol 
S750 
5504 
5235 


2383 | Same as No, 
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8009 
27930 
28510 


33300 
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103000 
126200 
| 116500 
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2844 
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8576 
9273 
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Table P3.6 (Contd. ) NOISE BEHAVIOR CHARACTERISTICS FOR A 150 
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P3.6 FITTING A NONLINEAR ViHICLiy WITH A LINEAR MODEL 

For 2 sinusoidal. input of 150 second-period to equation P3.6, 
the best lincar model which fits the noiseless sea trial data is 
given by equation P3272 ‘Ihe model reference contours for this cease 
are shown in Figure P3,28, and the noise behavior characteristics 


for the linear model are presented in Table P3.9. The noise behavior 














Non-Linear Veh.,Line Model Pp 
v=0, w=0 ~~ 900 158 
v=0, w=10% 905 157 
v=10%, w=0 000 545 
v:10%, w=10% 860 | 346 








Table P3.9 NOISE BEHAVIOR OF A LINFAR MODEL FOR THE 
NONLINEAR SURGE EQUATION 


4507 x = -16.7 x |x| +755 u [ul P3.6 
4507 x = -95x + 900u P3.7 


for this model is quite good (5%), although the optimum noiscless 
cost function value of 158 indicates that the fit of the linear 
model] to the nonlinear system for the 150 second-period sinusoidal 
input is about equivaient to a nonlinear fit with 10% v and w noises, 
Extensive model reference contouring studies were conducted 
using a form of the linear equation P3.7 as the vehicle and using a 
linear model. The details and results of these linear system studies 
are presented in Appendix Al3. These studies essentially snow that 


the linear system parameters are more accurately identified than the 
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nonlinear system parameter for the same noise percentages and for the 
pest inputs. 

This chapter has presented in-depth mode]. reference contouring 
studies of the DSRV surge equation. These studies were conducted 
femeea Variety of different inputs such as: step, staircase, 
erashback full astern, impulse, and sinusoidals of different periods. 
Of these inputs, the sinusoidal with a period near the "natural 
frequency" of the system was found to be the best for identification. 
Detailed noise studies showed in essence, that 10% v and w noises 
allowed about 10% identification accuracy for the two surge equation 
parameters. 

The next chapter presents several cetailed studies and identifi-~ 
Cations of the two parameters in the DSRV surge equation, As was 
done in this chapter, the parameters are studied for their identifi- 
ability characteristics using a variety of different inputs, However, 
the identifiability of the parameters in the next chapter using the 
extended Kalman filtering technique is determined based upon the 
accuracy of the final parameter estimates rather than upon the shape 


and minimum values of contours, as in this chapter, 
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CHAPTER Ply 

EXTENDED KALMAN FILTERING STUDIES OF SINGLE DEGRE OF FREEDOM DSRV 

This chapter presents the same types of analyses for the extended 
Kalman filtering identification technique as were described for the 
model reference technique in Chapter P3. The equations to be used 
im this section are those in Steps N3.9 through N3.16.0f Chapter 43, 
and one form of the actual computer program used is given in Appendix 
Al4, The vehicle equations and parameters are the same as those in 
Figure P3.1 except that the parameters are augmented into the new 
state vector x as in equation P4.1, and the value of 6 is arbitrarily 


set at 6 & py/4. 


xy xX 
= )%>| = |P, iereneuce F 3.) Perel 
X Po 


The application of extended Kalman filtering to the DSRY surge 
equation is a much more critical task than was the application of 
the model reference contouring technique, There are many factors 
which affect the behavior of the extended Kalman filter and determine 
both its rate and accuracy of convergence. One of these factors is 
that for given amounts of process and measurement noises, expressed 
by Q, and Ro the values of the corresponding values Q and R which 
are used in the filter may need to be adjusted for the best filter 
Convergence over the sea trial length. These Q and R values determine 
how the matrix E behaves and how large or smal] the Kalman filter gain 
matrix K becomes, 
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This chapter begins the presentation of the extended Kalman 
filtering studies by showing some trial runs made for the purpose 
of determining proper values for Q and R. Then, using these values 
the inputs are varied using the step, staircase, crashback full. astern, 
simulated impulse, and sinusoidal functions as was done in Chapter P3, 
Next, several studies are made using a longer sea trial length and 
mevang the values of a and Ro sequentially to study their effects 
upon the filtering process, 

This chapter then presents some very dramatic filtering results 
which were obtained by properly “tunins" the filter by adjusting Q 
and R and concludes by utilizing the extended Kalman filter (FKP) on 
the remaining 5 single degree of freedom DSRV models in Table P2.1. 
P4,1 ADJUSTING THE VALUES OF Q AND R IN THE EXTENDED KALMAN FILTER 

several extended Kalman filter runs were made with the staircase 
input, 1%v and 1%w noises for the purpose of determining the effects 
of Q@ and R upon the oe of the filter. The staircase input 
mun using Q = Qn, and R ss R will be described in complete detail here, 
and then later runs will have only the results tabulated and comments 
made about theme 

The sea triel data to be used in the extended Kalman filter 
Studies for the staircase input function, 1%v, and 1%w noises is 
Shown in Figure Pl.1. This plot shows both the staircase input 
function (curve 1) which is the same as that of Figure P3.2 and the 
resulting noisy DSRV surge velocity (curve 2) which is similar to 
Figure P3.1) for the no-noise case. 

The surge curves calculated for use in the extended Kalman 


filter are slightly different from those used in the model. reference 
/ =-20K- 
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contours because the step size H for the filter is one-quarter of that 
weed for the mcdel reference studics, This means that four times as 
many points are generated, and Figure Pl,1 merely represents a plot 
of every fourth point, This is necessary because the dynamics of the 
parameters Bnd the E matrix are somewhat faster than those of the 
surge velocity, and more precise integration must be used, It must 
be kept in mind throughout this chapter that the greater number of 
sea trial data points and extended Kaiman filter calculation points 
makes the noise percentages have a significantly preater effect than 
they did for the model reference contours of Chapter P3, 

The equations used for the sea trial data generation are repeated 


4 


here as equations P4.2 and P4.3. The maximum value of x during the 


W507, x = -16.7 x |xl + 755 u [uy +a Ply, 2 


2 = jor x(t.) = Q Pld 


sea trial is about 7 feet/second and so the standard deviation for 
gv is chosen as 0,07, and R,, becones 0,0049; the corresponding stan- 
dard deviation for 1%w is chosen as 1.7*1072 and Q, becomes 2.89%10"°, 
Using these equations and numerical values subroutine RKNL in 
Appendix Al4 generates the noisy sea trial data, which is plotted 
in Figure P4.1, by Euler integration. 

Once the sea trial has been generated, then the extended Kalman 
filtering technique may be used to process the noisy data and to 
identify the "unknown" parameters Py (-16.7) and p, (755). The filter 


must be “told” initially what the best estimates of the states and 
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parameters are and be given their corresponding initial error co- 
variances or standard deviations, The state cquations to be used 7 
the extended Kalman filter are given by equations Pl.4 and P4.5 and 
the initial states and their standard deviations are given by equation 


pi.6. The initial values of the parameters are chosen at about 25% 


x Xo % || + Xy uv] 

Ky = 10 PLY 
Xe 0 

Dy  X Pie 5 
x,,(0) =x [=11.2/M + 4,5/M PL. 6 
x3 (0) 943/M + 55/™ Where: M = 4507 slugs 


away Irom the true parameters and approximately one standard deviation 
Baeconiicence, for this run the filter is told exactly how much noise 


is in the data by equations P4.7 and P4.8, 


6 


Dre eha Om PL.7 


l} 


Q= 


b9*107? PlL.8 


=3| 
i 
me 
HH 


With this inforiation the extended Kalman filter may be run in 
passes over the sea trial data in Figure P4.1. Tne filter of Steps 
N3.9 throvgh N3.16 is implemented in this case by using the MAIN 
program and subroutines PROP, GAIN, UPDAT, and STORE in Appendix Al4. 
Fach pass over the data generates six output plots (x(t), p(t), 


Pp(t), o,(t), Op (es and op, (t)) which represent the time values of 
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the filter estimates of the states and parameters over the length 
of the sea trial along with their corresponding estimated standard 
Heviations, ouccesSive passes are run using the final best estimates 
of the states and parameters in the previous pass as the starting 
values for the next pass, 

The results or three extended Kalman filtering passes over the 
1% noisy sea trial data in Figure P4.1 are shown in the 18 plots of 
Figures P4.2 throvgh P4.19. These plots show how the noise is 
filtered out of the primary state x (Figure P4,2) and how the paran- 
eter values for p, (Figure P4,3) and Po (Figure P4.4) are arrived at 
by the filter, ‘The corresponding time value of the standard deviations 
of the state oe (Figure P4,5) and the parameters oe and. Op, Figures 
py.6 and P4.7) are also shown, This sequence of six plots is repeated 
three tines, once for each pass over the data, in Figure P4,2 
through P4,19, 

An enormous number of extended Kalman filter runs were made 
and the corresponding plots generated for the studies in this chapter, 
The results of these runs will be described here in tabular form by 
listing the noise characteristics, the initial values, and the final 
values of the parameters for each pass. The tabvlar form for Figure 
P4.1 through Pl.19 is given in Table P4.1. The values at the end of 
each pass are taken from the state and parameter plots and their 
Corresponding standard deviation plots. 

The numbers in Table P4.1 show that the filtered state estimates 
are biased about 5% aoe from the true values and that the standard 
deviations are extremely low. ‘This indicates that the filter has an 


extremcly high degree of confidence in these values of the parameters, 
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“11.2 + 465 943 + 55 










BlGelee 0W08 | 721 + 3 






“16.1 + 0.06 | 707 + 2.5 





Table P4,.) EKF, STAIRCASE, 1%v, 1%u, X juli. 7, QQ, R=R, 
This unwarranted confidence in the estimates of the parameters may 
be decreased by "telling" the filter that there is more noisé in the 
data than there actually is. This is accomplished by setting 

Q@= 5Q and R = 5R,, which has the effect of telling the filter that 
there is 2.2% v and 2.2% w noises. The results of the corresponding 


extended Kalman filter run are shown in Table P4,2, 


p,(755) 
“11.2 + 4.5 15) canes 
~16.3 + 0.2 730 + 8.3 


-16,.1 ot © ol. 709 aa 6 


16.0 + 0.1 702 + 5 





Table P4,2 EKF, STAIRCASE, lfv, 1%, x,=140.7, Q5Q,, R=5R, 


Feed aall 


The results of Table P4.2 are essentially the same as those for 
Table P4.1 except that the filter confidence in the parameter 


estimates has been slightly decreased, What is happening in both 
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y 


of these cases is that the extended Kalman filter FE matrix for this 
nonlinear estimation problem is becomimg too sinall, too rapidly 

over the length of the sea trial causing high confidences in biased 
Values, It is beneficial to recall at this point that in the model 
reference studies, v noise had a significantly greater effect on the 
contours than wW noise (chapter Rae This suggests that the filter 
should be told that there is more v noise than there is w noise, or 
that Q/R <1. The results of Table P4.2 suggest that both Q and R 
may need to be set significantly higher than the nee noise amounts, 


As a result of these considerations the next run is made using 


Q=10Q, and R = SOR « The results of this run are shown in Table Pu,3, 


“11,2 si 45 
~17,1 + 0.6 


~16.8 + 0.4 


-16,6 te G3 





Table P4,3 EKF, STAIRCASE, 1%v, 1%, xX =110.7, Q=10Q,, R=50R, 


The filter has been "slowed down" considerably in Table P4.3 by 
the increased values of Q and R. The time value of Py has been found 
to Within 1% and within 1 standard deviation whereas the time value of 
Py is about 5% away from the identified value. The error in Po and 
the high value of the filter confidence are due partly to the fact 
that the initial confidence of 55 represented a reasonably high con- 


fidence in an erroneous value, The values of the confidences in p, and 
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Py in this table represent about 3% of the true parameter values for 
4a case in which the noises are 1%, This suggests that the velucs of 
Q@ and R may be slightly large for the 1% noise case. ‘The next run 


is made using Q= Q, and R = 10K,, and its results are shown in 


Table Ph, lt, 






Initial “11,2 + 4.5 










Pass 1 “16.7 + 0.23 









Pass 3 ~16,5 + 0.14 





Table Pl.) HKF, STAIRCASE, lév, lu, x 140.7, Q-Q., R=1OR_ 





In the run represented by Table PH.4 the filter was told that 
there were 3.2% v and 1% w noises when in actuality there was 1% of 
each. The identification passes show that Py is identified to 
within 1% mean with 1% standard deviation while Py is biased away 
about 5% with a 1% standard deviation. It is also evident from 
this table and from the previous three tables that the second and 
third extended Kalman filter passes really don't provide the signif- 
ieant part of the identification of Py and Poe Most of the identif- 
ication results for Py and Py are accomplished in one pass over the 
Sea trial data for the DSRV surge equation. 

For the DSRV surge equation with a staircase input, 1% noises, 


= 1+0.7, and 25% erroneous initial values, the noise covariance 


Values Q= Q, and R = 10R,, are good values to use in estimating the 


“plor 





parameters. However, this does not necessarily mean that they are 
still good values to use when one of these major problem factors is 
changed, For a noniinear state estimation problem such as this one, 
the filter must be "tuned" to each variation of the problen, 

There is one computational problem which is sometimes encountered 
when using the extended Kalman filter with small amounts of noise, 
The BE matrix rapidly approaches zero in the filter and may actually 
become negative due to computer or system noise, Negative E causes 
the i matrix propagation equation to become unstable, and so some 
provision should be made to prevent this from happening or to correct 
it after it happens, One possible and somewhat arbitrary Soreseein 
procedure is given in Appendix A15, 

The next group of studies to be made with the extended Kalman 
filtering technique and the DSRV surge equation represent the same 
input function variations as used in the model reference studies of 
Chapter P3 and the fixed values of Q = a, and R = LOR. The input 
functions (step, staircase, crashback full astern, simulated impulse, 
and sinusoidal 100, 150, 300, 500) will be used with the 1% and 10% 
vV and w noise combinations, and the results of 3 extended Kalman 
filter passes over each run will be tabulated, 

P42 EXTENDED KALMAN FILTERING USING A STEP FUNCTION INPUT 

The step function input is shown in Figure F3.2, and the results 
of the 1% and 10% v and w combinations of noises using the extended 
Kalman filter are presented in Table P4.5, These results essentially 
Show that 1% noises permit 1% identifications and 10% noises permit 
10% or better identifications using the step function input. A 
comparison of this tubdle with the corresponding model reference results 


=2e0- 





in Table P3.1 shows essentially the same results but with the FKP 


giving slightly better identifications in the 10% noisy cases 
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nO 784 + 11 712 + 80 


730 + 78 


Table P4,5 EKF, STEP, 1% AND 10% NOISES, GQ R=1OR 








P4.3 EXTENDED KALMAN FILTERING USING A STAIRCASE FUNCTION INPUT 

The staircase function input is shown in Figures P3,10 and P4,1, 
and the results of several noise combinations (1 and 10, 10 and 20, 
1 and 100) are presented in Table P4.6. The initial values for 
Table P4.6 are the same as those in Table P4.5 and are not repeated, 
The results of Table P4.6 show that 1% noises permit 4% or better 
identifications, 10% noises permit 40% or better identifications, 20% 
noises permit 60% or better identifications, and 100% noises permit 
80% or better identifications. The two 10% v 10% w cases are different 
because different noise starter integers were used in the noise 
senerating subroutines. 

The results of the staircase input function identifications 


using the EXF are surprisingly poor when compared with the step 








function identifications and with the staircase model reference 
Mei ticaetions in Table P3.¢, The primary reason for this is that 
the Vand Wpnoises Biter the EKF at 4 times as many points because 
of the reduced step size, and .therefore these noises behave as the 
equivalent of about 4 times their actual percentages as determined 
from comparing Table P4.6 with Table P3,2. Thus the "modified" 
results are thet 4% noises permit 4% identifications, 40% noises 
permit 40% identifications, 80% noises permit 60% identifications, 
and 400% noises permit 80% identifications, 

These modified results show that the filter behaves about the 
same for the staircase input as it did for the step function (unmod- 
ified) and about the same as the model reference results in Table P3226 
Tne results in Table P3:.2 for the larger noise cases are somewhat 
misleading in accuracy because the contours were constrained to 
+ 50% parameter variations, The 60% and 80% identifications for the 
80% and 400% noises arc possible because the filter is “climbing the 
wali" in Figure P3.13, which is caused by the fact that as Py 
approaches zero the surge equation approaches instability. The HT 
noise for large percentages causes such large biases that the vehicle 
never slows below 5 ft/sec over the staircase input sea trial. 

P4.4 EXTENDED KALMAN FILTERING USING A CRASHBACK FULL ASTSRN INPUT 
The crashback fvll astern input is shown in Figure P3.14, and 
the results of the 1% and 10% v and w noise combinations are presented 
in Table P¥.7. These results show press for this input function 1% 
noises (4% modified) permit 10% or better identifications and 10% 


noises (40% modified) permit 20% or better identifications, These 


a2) 





LO%n l0fv 1% | l0%vy lotu 


~16.5 ae WHA 
(7 +9 
-16.5 


Noises 10%v 10%w l0%v 20%w 20%v 10% 20%v 20% 


“22,6 42.1 | -12.1 +1.8 | -13.3 + 2.5 
786 + 79 683 + 96 782 4 134) Weyeomeaies 
-24.2 +1.8 | -11.7 +1.3 | -13.0 + 2.1 | -7.4 41.5 
812 + 68 652 + 69 (557) le 630 + 103 
Seeger eye | 11.5 41.1 | -12.8 41.8 | -6.9 + 1.1 


826 + 61 641 + 56 714 + 98 585 + 83 


1%w |100%v 100%w 


Same as 60) te WA Nea Gea) | Ss 3,7 
: 608 + 101 912 + 183 | 969 + 183 
“DGS ie AMES sas erie || onl as 255 
pee 79 894 +178 | 935 +176 
“505 +069 | -14.0 + 3.5 | -3.1 + 1.6 
508 + 67 882 +174 | 883 + 168 





Initial Values Same as Table PY, 5 


Table P4.6 EKF, STAIRCASE, NOISE COMBINATIONS, Q-Q_, R=1OR, 


ere Oe oe 2 et ee OE et 
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lev 10% 10%v 1%y LO%w 


“15.3 +1.3 
732 + AY 
“15,3 + 0.9 
(eget Oe 
“15.3 + 0,8 


Cena e/ 





Initial Values Same as Table Pl. 5 


Table P4.7 EKF, CRASHBACK FULL ASTERN, 1% AND 10% NOISES, 
@=Q,4 R=LOR 


values are not as good as those for the model reference contouring 
technique in Table P3.3, but the "modified" noises again cause mis-~ 
leading conclusions, The fact that effectively 40% noises permit 
20% or better identifications indicates that the EKF is at least as 
accurate an identification technique as model reference contouring 
for this input function, These errors might also be reduced by 
eajusting Q@ and R for this input or by using a better integration 


technique. 


P4,5 EXTENDED KALMAN FILTERING USING A SIMULATED IMPULSE FUNCTION 
INPUT 


The simulated impulse function input is shown in Figure P3.15, 
and the results of the 1% and 19% v and w noise combinations are 
presented in Table P4.8, These results show that 1% (4% modified) 
Noises permit 25% or better identifications and 10% (40% modified) 


noises permit 30% or better identifications, using the simulated 


ele 








Noises lev ls Vv 10%ba LOZ. ww [10% 1O4w 





Pass 1 P, “1205 + 008 |-14.7+1.0 |-11.3 4+ 0.9 
D, 60" + 68 676 + 4h 583 + 43 
Pass 2 Pp, et2s5 +206 |-14.7+0.7 |~11.3 4 0.6 
PS 605 + .64 673 + 34 | 576 + 30 
Pass 3 Py pize/ + 305. j-14.7 40.6 |-11.3 + 0.5 
P, 605 + .63 672 + 28 S73 es 





Initial Values Same as Table Plt.5 


Table P4e8 EKF, SIMULATED IMPULSE, 1% AND 10% NOISES, Q@-Q,, R=10R 
ty 5 ere ce ae 


OM A MR Pe gO 








impulse function input. The high degrees of confidence which the 
fazter has in the biased values indicates either that this is not a 
good input for the EKF or that the values of Q and R need to be adjusted. 
The identifiability characteristics of the EKF using this input are 
far worse, even considering the modified noise behavior, than those of 
the model reference contouring technique in Table P3.4. 
P4.6 EXTENDED KALMAN FILTERING USING SINUSOIDAL INPUT FUNCTIONS 

The input functions used in these runs were Sinusoidal functions 
of amplitude ./2 and of periods 100, 150, 300, and 500 seconds. The 
results of multiple runs conducted with these four sinusoidal input 
functions are presented in Tables P4.9 through P4.12. The results in 
Table P4.9 for the sinusoidal-100 second input functions show some of 
the problems which may be encountered when using the EKF, For the low 
W noise cases in Tables P4.9 and Pl.10 the filter dynamics were so fast 


that the Euler integrator, even with a step size of 2.5 seconds, could 
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muekeep Up. Also, it is evident that Q = Q, +5 much too low for the 
Ey when using any of the four sinusoidal input functions of 
Tables P4.9 through P4.12. 

The essential results of Tables P4.9 through P4.12 may be sum- 


marized in abbreviated form as follows; 


100 second, 10% noises permit 25% or better identifications 
150 second, 10% " 30% " " 
20% " ; OZ " " 
100% " ‘ 50% " " 
300 second, ee ‘ 15% " " 
07a " 10% " " 
500 second, iy ae vs 10% " " 
10%" 20% i " 


It may be expected that some of these figures could be bettered by 
readjusting the values of Q and R, by decreasing the integration step 
size and computing more points over the filtering process, by increasing 
the length of the sea trial, or by using a better integration method, 
such as Runge-Kutta, A comparison between these tables and the cor- 
responding model reference results in Tables P3.5 through P3,8 shows 
that for sinusoidal inputs the EKF is not as accurate as model refer- 
ence Contouring unless the “modified" effects of the noises in the EKF 
are taken into consideration, 


Py,7? EKF USING A LONGER SEA TRIAL, CLOSER INITIAL BSTIMATES, AND 
RUNGE-KUTTA INTEGRATION 


The operation of the extended Kalman filter is much more critic- 
ally dependent upon the input function, the initial state and parameter 


estimates, the values of Q and R, the length of the sea trial run, and 


-236- 





a a Py eee 


Noises l%év l%w lyv 10% l0Zv 1% | 10%Zv 10% 


Sipe? | -14.0 + 416 | -13.4 41.3 | -11.8 41.2 





605 + 0.1 652 + 719 + 29 702 + 28 
~26.0 + 10°? | -16.7 13, Sede) 0 | =e ono 
519 + 0.1 610 + VA? + 2 701 + 20 
ee 10 |-23.4 % .003 | -13.3 + 0.8 | 11.7 + 0.7 
4W17 + 05 525 # 0.1 716 +17 701 + 16 


20% 20%V 10% 20%v 20%w 


“12.4 41.3 |[~-12.9 42.1 | -ll.1 + 2.1 

714 + + 724 + 56 692 + 54 
“1442 +1. 240.9 | 12.9 +127 | -10.6 +1.6 
714 4 + 715 + 40 684 + 39 
“4,1 + el + “12.8 +14 | ~10.3 +1.3 


714 4 + 712 + 33 681 + 32 


100%v 1% 1L00%v 100% 


8,541.0 | -12.2 + 4.0 | -11.3 + 4.0 

eon 30 879 + 161 786 + 159 

“8.3 +007 | 1207 + 3.8 | -10.7 + 3.8 

674 + 22 845 + 142 692 + 139 

meme 0.6 | =13.1 + 3.6 | Ono a ge6 

672 +18 824 + 129 623 +124 
Initial Values Same as Table P4.5 


Table P4.10 EKF, SINUSOIDAL, 150 SECOND PERIOD, @-Q,, R=lOR, 





e = sae -2 eee FD 


2237. 








PP LE TIES EA aR TE RP EC TE aE Faas 18 eae. 


lOZv 10% 


sly #202 |-12,7 + 1,9 | 12.6 + 1.9 


634 + 0.4 Thy 4. 37 738 + 37 


-27 + .02 | +12.6 + “12.6 +1.5 
0.2 740 + Tae? 
“A256 4 Led | =l2s6e dn 3 


250 + 03 + 739 + 22 733 + 22 





Initial Values Same as Table P4,5 


Table P4.9 EKF, SINUSOIDAL, 100 SECOND PERIOD 1% and 10% NOISES, 
Q-Q,, R=102, 


ay a re oe, ore ae 10%v 10%w 


-14,0 oy 0.9 
698 + 31 


-14,1 sls Os 


699 + 23 


“14,2 + 0.5 





Initial Values Same as Table Pl.5 


Table P4.11 EKF, SINUSOIDAL, 300 SECOND PERIOD, 1% AND 10% NOISES, 
Q=Q,, R=10R_ 


the speed and accuracy of the integration method than is the model 
reference contouring technique, The previous studies of this chapter 


have shown that with slight preliminary adjustments the EKF is nearly 
-233- 








TT, I ga I a tS 





vw ise =| (ey 10% =| low ite | ios osu 
Pies +. Oe) |) -seeaeten |) 38BN1,0 
667 + 688 4. 8 Sse ee 
aaa siemees | -15.2+0.8 | 13.2 40,7 
665 68/4 + 6 697 + 32 612 + 28 


-14,8 ae £05 -j14,8 a ree ~15.2 sd 0.7 -13.] “is 0.6 


664 + .02 682 + 5 695 + 26 611 + 23 


Initial Values Same as Table P4.5 


Table P4.12 EKF, SINUSOIDAL, 500 SECOND PERIOD, 1% AND 10% NOISES, 
Q=Q» R=1OR | 


as good as the model reference technique for low noise percentages 
and is a much better technique for high noise percentages. The fol- 
lowing studies will show that for a better intepration technique, 

a longer sea trial, and slightly closer initial estimates the EKF can 
be made to operate as well. as model reference contouring in the low 
noise percentage cases, 

A large number of EKF runs were made by the author using the 
Staircase function input with Runge-Kutta integration in both the sea 
trial data generation subroutine and the EKF state and error covariance 
propagation subroutines, The sea trial time step was increased to 
H = 4 seconds, and the input function step times in Figure P3.10 were 
increased from 100 and 200 seconds, to 188 and 376 seconds respective- 
ly. The EKF was told that there was 2,2 times as much noise in the 
data as there was actually by setting Q = 5Q, and R = DR,e The initial 


Values of Py were specified to within 25% and one standard deviation, 
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and the initial values of Pp, were Specified to within 10% and one 
standard. deviation. ‘The noise percentages used were 5% v (20% 
effectively) and 2% w (8% effectively). The results of four of 
these runs are shown in Table P4.13 for four different combinations 
of initial estimates.of the parameters, 

The EKF runs described in Table P4,13 show how remarkably well 
this filter can identify the DSRV surge parameters when it is properly 
mined’ and when it has a good integrator, These numbers show that 
5% v (20% modified) and 2% w (8% modified) noises permit 5% or better 
identifications from any of four directions represented by the four 
different initial conditions which are 25% and 19% away from the true 
values initially. The Fortran IV statements for subroutines RKNL and 


PROP using Runge-Kutta integration are presented in Appendix Al6, 


Initial Q= 59, H= 4 sec., Staircase steps at 188 and 376 sec. 


Values R = DR Sp, = 6, = = 50, X, = 1s, Int. = Runge-Kutta 


ie ; " FO 40,8 |"=16,5 GNONom | AIGRONONe 
781 + 40 725 + 39 
+ slew class Or 7 

726 + 33 

-15.9 + 0.6 


Table P4,13 EKF, STAIRCAS#, H=4, 5%v, t, RUNGE-KUTTA, 
DIFFERENT INITIAL Sane 
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P4.8 SOME DRAMATIC EKF RESULTS WITH LARGE AMOUNTS OF NOISE 
Wnen the noise percentages are increased, and the "tuned" filter 
of Table P4.13 is used; then the identifications of Table Pu,1u are 


generated by the filter, ‘The noises used here appear so evidently 


Initial p's p, = 713 + 465 


25%V 25%u 
75%v «7 5pw 
Initial Values same as Table P4.13 except as noted 


Table P4,14 KEKE, STAIRCASE, RUNGE-KUTTA, LARGE NOISES 
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in the sea trial data and are filtered out so dramatically by the EKF 
that the author decided to include the actual plots which were 
generated, The staircase input function and the sea trial data for 
the cases of 25% and 75% noises (v and w) are shown Mesias P4. 20 
and P¥.24, The extended Kalman filter estimates of the vehicle surge 
velocity during the sea trial and of the parameters Py and Po are 
shown for these two noise percentages in Figures P,21 through P4.23 
and Figures Pl.25 through P4.27 for the 25% and 75% noises respectively. 
In the model reference contouring technique used in Chapter P3, 
the actual identifier was the "observer" of the contours, In Figure 
P4Y.24 for the 75% noisy sea trial, it is practically impossible to 
"observe" even the vehicle behavior over the sea trial, not to men- 
tion evaluating the mathematical model parameters, In fact, an 
observer might wonder whether or not there is any ocean vehicle 


behavior at all in the "hash" of Figure P4.24, A quick look at 


Hpi. 





=O 


0.16% 
0. 37> 
9.48% 
0.64% 
0.80* 
0.96% 
te) 2% 
1.78% 
1.44% 
}.60% 
le 76% 
1.97% 
228% 
2074* 
2 040% 
20 56% 
2ei?* 
288% 
3004%* 
oa20% 
© otehg 
ou 02 * 
3.68% 
3. 84~ 
4.00% 
4.16% 
432% 
448%: 
4.64% 
4.80% 
4.96% 
5.12% 
507 8% 
5 044% 
52 60% 
De 76% 
50 9P% 
6.08% 
602 4% 
6.40% 
6.56% 
6.72% 
688% 
1.04% 
1.70% 
16 36% 
1.52% 


=O 


coc len 9) 
INCREMENT 7S Oa O88 1211 
0064321457F 09 fee oa) 5 TE 0} 
feeoo”:6« CUOlmVML TSE CUO] CUP OF Ol) UC 8 4GE 01 


als at te *, ate i , 
Meeee coset oece™oeso* coon nooo sooo aece? 


Pokey 3% 


Ol 


1263.6 O01 


; ¥ 


? 
Ge@eoo0 


3: 
¥. 
bad 


es 


“@e0o 


eel ee oe ee ee eee ee ee od 
N 
cad 


N) 
tet te Ke He 


IN 


x 


oe he Se KH 


N 
+ 


NS 
N 
¥ ve 


N 
x 


we & % 


oP a 
wows 


Figure P4,20 SURGE SEA TRIAL DATA, 
25% v_AND w NOISES, 


OTAIRCASH INPUT 





2 


Mee HH HH 


4+ 


NI 


% 4 


“= 
ed) 
ae.) 
== 
“Y 
fn 
> 
=> 
a 
om" 
~> 
A» 
2 
= 

(a) 
fy 

A 


4 a 


N 
ara 


3h 


elit mall oe EE ee ee coe” De ee ee 
N 


ek 


——t 


: mi 
4 SE 


043F OC 


. ne 
Sebon te ee : 


CVs 6 


2 4 x a) valet a 


“fF © 0 @ ©0o0o G 


Peele t 9 O.29E 01 
-242- 


“ 
oof 06 6 6 © 


Cea Oe QO} 


Ce80C8462E 0) 
Corer OF 


0.16 
(Venere 
0.48 
OR 64 
Ce 80 
0.96 
le1l2 
1.6278 
1644 
ine 60 
le te 
1492 
2208 
Le 2% 
2640 
lags 3.8. 
PatiZ 
2288 
3004 
3620 
GiagoiO 
ae oe 
4664 
3484 
4.0 
4.16 
4-32 
4.48 
4264 
4.8) 
4296 
53 12 
5028 
5244 
5260 
52 16 
50932 
4.95 
662% 
6240 
6456 
Gs te 
6.88 
1504 
1629 
71.636 
T< 52 


O.89E O1 





PLOT } 






Peue es THCREMENT IS N.1259714E O1 
0.6588594E 00 053808145E 01 0866574345 oi 
MeeoreeO «6«0.19F 01 9.37F 01 O644F OL O.STE Cl O0-70£ O1 

BER fe Bwln 5 abs ee ce Meet be Naas oe cca“ cccetancerteecce™ 

0.16% 1 * O16 
a 32 1 * O.37 
0.48% ] * O64 
0.64% 1 * 0.64 
0.80% } * O80 
0.96% } * 0.96 
milk ] x 
1.28% 1 * Sesele 
1.44% ] Fl. ae 
1.60% 1 x Ge 
Le 76% 1 % 1.76 
m92* ] 7 ae op 
2.08% :  2eO 8 
Pa2dht 1 xf Zi 2% 
240% ES 
2.56% 1 * 2556 
m2 : ES ee 
708% 1 * 2.88 
3.04% ] & Soae 
34 20% 1 ¢ 3:20 
3436% 1 ® 3.36 
3.57% 1 * 3:52 
3.68% 1 #& 268 
3.84% 1 * 3.84 
4.00% 1 = &.00 
Be 16% | x 4.16 
32% ] y 2.20 
4.48% 1 * 4,48 
a ] EKF SURGE VELOCITY ESTIMATES | tee 
Mog } eee alle, 
56 12% 1 * 5.12 
528% 1 = 5.28 
50 44% 1 k 5.44 
5.260% } * 5.69 
oe 1 6X 1 = yet 
569P% oY : 5.92 
6.08% 1} VEHICLE SvR6E E@QR, * 6.08 
6e24% |} A Gia6 
6.40% ] Y T/sée * 6.40 
6.56% | * 6,56 
6.72% | Estria arEes Fete t 6842 
6.88%) x 6.88 
7.04%} ASE, NESEY BATA . ee 
T.70*%] abe * T.20 
7.36%1 | , a3 * 7,36 
152%] * 74652 


x AJ 4, e a Ts ale Zz 
MEM Stag o Palco ce NccdecKec sce sbactbseo” 


0e66F 00 O.19F Ci NAA Gi (e444 0) (OUST We Cewe. 


o~ 3- 


= ¥ 


* al 
e6oe”" oe ee “on © 8 


i ' eee 


¢ 
- 
=- 
~ : 
- 
- 
‘ 
- 
oO 
‘ 
st oF - . 








OS 


TOOT ee 


> 4 


~eeee™ INCREMENT 
Bet 05257EF C2 


ey 1 ? 


IS OmSlIE5TTIE 00 
momo O07 BRE. 02 


“O05 2953728 


O72 


Meee? ~Oe16F C2 -0.15E 2 -C.15E 62 -O.14F 02 -0.13E 92 


ie 1 6* 
ie 32% 
0.48* 
Oe 64% 
0.80% 
0.96% 
1.12% 
La? 8* 
1.44% 
1.60™ 
}e 76%: 
ile 92* 
Nek 
2024% 
22.40% 
Pe 56% 
2el2* 
2288* 
3204*% 
3.20% 
36 36% 
3.52” 
32.58% 
30.84% 
4.00” 
416% 
4.32% 


 4e4R% 


4.64% 
4.80% 
4.96% 
5.212% 
5078 
5 244% 
560% 
50 16% 
569 2% 
6.08%: 
66274* 
6.40% 
6.56% 
60 712%: 
6.88": 
mG 
16 20% 
1.36% 
52% 


0) 


x 


bad 


=" pont 
Uwe al 


a ¢) 


~~! 8 


a 
= 
.. 


1.7 


x 


- & @ane 


7: *k 5 ” 
"~@60e0@e0’"'o @©@ @ @eoesc "aa @ 8 





é ‘ 
=¢ 4 
“~“e0oe0on’"*e@ 6 © @ 


See o O72 —Ue5— C2 -O415E 02 


Wars eee et ene bc 0g o Hed be Me at 
} 
} 
l 
} 
i 
1 
iy 
1 
1 
) 


Figure Pl.22 FKP PARAMETER p, IDENTIFICATION 


FOR FIGURE P4.20 DATA 


es 





VWEHICLE SURGE EQ. 
DRAG CobFE FICIENT 
COENTIFICAT (003 


fe TRve vare€ (6,7 


%: 


ok 


ye : 
On A Ae 


2h) 


=de a 
ennanTTaren eceo 


—-0. 1490290 cr 


© * 
] * 
1 * 
1% 
% 


RY) 


Hemet etee HHH Ee 


% 


DNs 


ie) 6 
Os G4 
9.48 
0.64 
Ox BY) 
0.296 
je ee 
1628 
164% 
1660 
lig 76 
1.92 
2208 
2024 
Guat: 0 
Zuo 6 
Zac 
2-288 
3204 
Sac 
Se53 6 
SB y'D 7 
3mub3 
32.84 
4.60 
4216 
4632 
4.48 
4. GG 
4.80 
4296 
ant 2 
3: 
5244 
err: & 
Ss 16 
iy 92 
6.08 
6.24 
6.40 
Ges O 
6412 
ots 
1694 
7220 
1636 
1h §e 72 





0 


0.16% 


0.37% 


0.48% 


0.64* 


0.89% 
0.96* 
1.12% 
1.78* 
1.44% 
1.60% 
1. 76% 
a 2% 
eg 
2024™ 
2040 
256% 
2et?* 
2288 
3.04% 
eae O™ 
3236" 
34.52% 
3268* 
4284 
4,00™ 
4.16% 
4.327% 
4.48% 
4.64% 
4.80% 
521 2% 
502 8% 
50 44% 
5.60% 
52 76% 
5.92% 
6.98% 
6.74% 
6.40% 
6.56% 
6.072% 
6. 88x 
12.04% 
1.20% 
1.36% 
1.52% 


() 


PLOT 

Meee NT TS Q.4387499EF 0} 
Geiger olr 02 

mes 90.78F 03 O79F 93 CLTIE 03 


: 4 “Eg SI 4 
” on te 6 6 ee “f 


3 


&, Uns 
IK 6 $6 om 


Seer (oor? Ze 03 
O.80F O03 


alee % ane © 6 owoe “aeve 


} 
) 


} 





Figure P¥,23 EKF PARAMETER Po IDENTIFICATION 





FOR FIGURE P4,20 DATA 


1 VENIceE SvuR6E EON, 
PRoPE.2 of Ceeeemwenr 


I TACHPIP IATIGH 


1 x Teve vasve 7SS, 


Crom sHowl) 


ll ee 


- » 
» Gl 
a ee 


fone oe 


mere os «60. 78E 03 


$y + ha of: Xd 3 
mene dave co we 6 60 © @ coooX*%eooe 


ers 03 G.79R 03 9G. RUE 
~2N5= 


Os 


Oe-800B147E 
ORGOE “03 


ve r § +, 
o eee Tb 6 6 a ale «0 Kee bm 


% 
a 


1% 


Xn £ HX £+HHeMeHHK HN H € * 


+ 


yal 


0.)6 
Ona 
9248 
0.64 
Dera O 
0.96 
1.)2 
1.28 
1644 
e690 
le 76 
lee2 
2008 
et 
22049 
2400 
ZR? 
2288 
3-04 
32620 
36,50 
Sy B24 
3268 
3 84 
4.00 
4.16 
4.32 
4648 
4.264 
4. 80 
4.95 
512 
390 28 
5044 
58669 
5 ats 
56°92 
6.08 
6624 
6.640 
56 
bolZ 
6.88 
1204 
te20 
mer36 


sa at 


, ¢. ° 
St gle Skt cmeire 6 on 


O.80EF G3 





= i lard = os =- 
7 | ° ei — = ‘ 
= - * 
. 
' 
' 
7 
é 
. 
4 
| 
' 
> 
' 
' 
- . 
= 
* 
‘= = ] tee’ -«*% &© te @ oé ae & oe = 





-0 


0» 16% 
0. 32* 
0.048% 
0. 64% 
0. 80% 
0. 96% 
Py | Ad 
1.28 %* 
1644 %* 
le 60% 
Ll. 76% 
1o92% 
2 08s 
20 24% 
2040% 
20 56% 
2e (2% 
20 88% 
3004% 
3020% 
30 36% 
3052% 
30 68% 
384% 
4.00% 
4.16% 
432% 
4048 % 
4e 64% 
489% 
40 96% 
50 12% 
50 28% 
50 44% 
5 60 ** 
52 16% 
50 92% 
608% 
6624% 
6640 % 
60 56% 
6672% 
60 88% 
1204 
To 20% 
Te 36% 
1652% 


“16 


PLOY 0 

INCREMENT 25 062986815E 0} 
Oo3110521£ 01 

044E 01 -Col4E 01 OclGE 01 0646E 01 


+ » ty ° e 
Peeeoe*eo ee *eooo® »¢ Ke 


t ‘ 
Seven 


06435551 7E Oi 
O. 76E O} 


*e a! . t) 
“eeco“soovo%cococeeoce< 


Z 


¢o 086 oo 0898 


Zz rd 


fmt fret ft feet fat pet et eet fd fet es 


a ee ce Oe ee ed ee Oe 


= ee 36 
Figure P4,24 SURGE SEA TRIAI« 
DATA, 75% v_ AND w_NOISEHS, * 
STAIRCASE INPUT 












me. 82 
2 


URGE BQvareot x 


Pet amd amd eet frat peed feet feet Py faet Beet fened fet feat peat feat feed feat feat fat feed fed ree 


1 2 | 

Demab tse 6 bs ccc tecec*eoce oXeaoco*occo*eo oe oe oa 

o44E O01 -Osol4E 01 Oc1G6E OL O646F O1 C.76E O1 
~2hb~ 


$e ry 
*eooco 


O. 1057756E 


02 


O.11E 02 


0.16 
Oo 32 
0048 
O. 64 
0.80 
0.96 
Va 2 
1626 
1044 
1. 60 
lees? 6 
le 92 
2208 
2024 
240 
2056 
2612 


*« 2.88 


3004 
Si 20 
3236 
3052 


e) Sm 8 


3084 
4.00 
4e16 
4032 
Lee 48 
4064 
40 890 


§ 4696 


5el2 
52 28 
5044 
50 60 
52 16 
Su 72 
6008 
6024 
6640 
6656 
6072 
6688 
1204 
1e20 
To. 36 
#052 


Om debE Or 


- 
———— ' 
= 
-_ 
_ 
- 
=: 
- - 
. ’ 
# 
- <- 





Rie T E 





%eooe™® INCREMENT IS 0.1390034E Ol 

0.6557458E 00 064130830E OL 0. 7605918E 02 

Os66E 00 Oe20F OL Oc34E O01 O448E 01 O.62F O01 O0476E O02 

Kesoococo*ocvco“ocoo conc vcooo*oeosorX%ce corcenek*eoccert 
0.16% ie: . % Owmlo 
00 32% 1 * 0.32 
0.48% 1 *¥ 0.48 
0.64% 1 * 0.64% 
0. 80* ] * 0.80 
0.096% M * 0.96 
1.12* ) *% 1.12 
1.28% ) *¥ 1.28 
1044 %* J * 16 44 
le 60% ] * 1.60 
le 76% i * 1.76 
1.92 * ik * 1292 
2208* 1 * 2008 
Ze 24% i * 2624 
20 40% it xe 2240 
20 56% Ny * 2256 
4 * Figure P4.25 EK SURG® ees EOTIMATES ie ay 
36 04 eee DATA 1% 3604 
320% 1 wh 32d 
3036% | °F) 2286 
30 52% * 3-52 
35 68% * 3068 
30 84% 3084 
4.00% © 4,00 
4e 16% = 4e16 
4.32% K 4.32 
46 48% 4048 
4.664% 4,064 
4, &0* 40 60 
de 96% . + 96 
5012 1 ViiteeeG SvuR6E EQUATION « 5,12 
56 28% 1 a ‘ * 5-28 
50 44% ) 08 Fe MEESE * 5644 
5.60% 1 * 5.60 
ee 1 ise Pass V@soety & 5676 
592% l = 5692 
6.08% STATE ESFIMATION * 6508 
6.24% } Fy * 60 24 
6640% } Ue PY/sé¢ * 6640 
6.56%} * 6,56 
6.72% * 6672 
62-88%) x 6.88 
Te 04%] * 71204 
Te 20%] x %o20 
To 36%] * 71.36 
To 52% 1 x 7.52 

Koeec tcc coX%onveXcocetecootoocotooce toe cot eooe*eeon® 


O566F 00 O52CE 01 Co34E OL O648F 01 Oe62E OL Oe f6E OL 
~247~ 


a“ = —.* ‘ 





a 
‘ 
7 
L 
'* 
: 
‘ 
> 
®& 
¢ 
L] 
' © 
» © ‘ 
tI] 
| 
a 
° 
= =—e 
. ’ ‘ + so * ‘ 4 tL Ss. - 
, “Ti. = iw | me a Oe eS 





PLOT 2 

Heoeeo® INCREMENT IS 06595436ZE 00 
=0.1591288E 02 -001442528E 02 -001293669E 02 
BOSEGE 02 -Ocl5E 02 -0.15E 02 -0.14E 02 ~00)14E 02 -0013E 02 












Mee ME See “coco secoo*eees*cocetocce “oe cer 5 a Skee Mo's 0 6 ¥ 

Oo 16% 1 * 0616 
0. 32% 1 * 0.32 
0048* 1 * 0048 
Oo 64% 1 * 0,64 
0. 80% 1 * 0.80 
0096% 1 * 0,96 
le l2* 1 * hay2 
1.28% 1® 4 ves 
1.644% x 1444 
1. 60% ee 1 * 1660 
1.76% {Figure P4.26 EKF PARAMETER p, IDENTIFICATION 1 Se Ma ac 
1.92% ——<_ x 1492 
2008 % FOR FIGURE P4.24 DATA : 1 * 2.08 
20 24% ] x 2.24 
20 40% 1 x 2640 
20 56% 1 *% 2.656 
Be i2* % 2072 
20 88% 1 * 2.88 
3 04% l * 32.0% 
36 20% *% 3.20 
350 36% x 3,36 
36 52% oe IH 2 
30 68% .- : % 3 a8 
30 84% * 3,84 
4.00% 1 * 4.00 
4_ 16% l * 4el6 
4, 32% % 32 
bo 48% ih 4648 
be 64% 1 * 4eO% 
be 80% ! VEM«LE SURGE Ear,  * 4.80 
4e96% 1 x 4 96 
5.12% 1 PSB herse * 5.12 
56 28% x 5,28 
56 4h NF " DRAG COEF ieiear & 54h 
5.60% 1 * 5.60 
mor } FORM TIE ICAT (00 5.76 
50 92% ] , * 5,92 
6.08% © 1 pase ( —-® 6408 

* oe woe 
ms, | we TRvE VALVE, ~16.72 5 eto 

by 4 e 
oe 1 ( Mer aaa " a ie. 
be B81 x 6568 
7004%1 x To 04 
ol * 7,20 
636%] | @& * 1.36 
7% )™ bed © P52 

wes thte ee ones ®ocse®o oc ste ocee*% eos 0” Feta’ 2S CK's tee ws 
=Ce1lGE O2 -O0e.15E 32 ~361i5t GZ ~O6iLl4E O2 - OoiszE O2 -Ool3E O02 


~2U8~- 


PLOT e) 











Keoee™® INCREMENT IS O,181I4G1IILE O} 

Oo 7SiLS745E O03 Oe (961 096E 03 0,.8005450E 02 

OS79E 93 Os/9E O03 OeSOE 03 OL8OE 03 O.80FE 03 0.80E 03 

Keoeeo*s00oeooe* nooo sooo%coootcoce*oocotovvecocex 
0.16% ] * 0.16 
0.32% ] * OO. 32 
0. 48% ls 0648 
0. 64% ] cs 0.64% 
Oo 80* ] * OO, 80 
0.96* ] * 0.96 
16-12% ] * Jel2 
1.28% lL * 1.28 
1644 l 1044 
1. 60* l * 31.60 
le 16%  y ( b | a a. %,1e76 
 . . ee ee ; | a he 
20 08% : 1 * 2.08 
2024 l * 2624 
2040 % l * 2,40 
20 56% ) * 2456 
20%2% ~ ae l | ae * 26 12 
20 88% a Oats el ae aa ~ 2.88 
3004 * =>, 1 ag , ee ees 
Ee | a - a AE 3220 
3036%* it * 3.36 
39 52% l | S 2a52 
3068* ly : eet ao * 3. 68 
36 84% 1 Figure P4,27 EKF PARAMETER Po IDENTIFICAS| me” tee 
400% ik eee | ere 
4.16% 1} TION FOR FICURE P4e2h DATA | « 4.16 
46.32% 1 = "= 8 4a72 
448% J *~ 49 48 
4e 64% l % fe 64 
4.80% 1 * 4680 
4.96% ? x 4696 
5.12% 4 — VEHIELE SvO6E E@R, « 5.12 
56 28%) » * 5,28 
50 44%] 7S f NOLsE K 5044 
50 60% ~ % 5.60 
er PRoPELLOR CORFF, * 5076 
50 92% ; * 5592 
ot E pled? Pie Arion %* 6008 
6624%] * 662% 
6640 *1 PASE ' * 6240 
6. 56%} * 66256 
6672%] PRHE WALUE SSE, * 6072 
66 85%} | ca ® 60 88 
To 04%) . a 2 vee ' : ‘eg - . tan Sa Te04 
| ae Mh 
Te 36%] van PD ‘ x 7626 
To52%) che Ode * 7252 

* Keaocek*oooe*coe otocc ofooeuroeeo*o000 on 00 %o00e™® 


"00 6 @% 


Uei9E 02 O.7SE 032 O680E 03 O.80F 03 O.80F C2 O28UE O35 
~2)9- 





Figures P4.25 through P4.27 reveals how dramatically the EKF picks 
out the DSRV surge velocity and the two vehicle parameters (especially 
P,)« The reason that the filter can do this is that it has been 
given the exact absolute square law structure (Equation Py, tr) for the 
vehicle generating the data and it has been "tuned" to look for the 
parameters in this structure, 

For the DSRV surge equation the EKF is much more difficult to 
implement and tune than the model reference contouring technique, 
but once operational it allows remarkable identifications, This 
version of the filter may now be applied to the six individual single 
degree or freedom models of Table P2.1. 
P4.9 EKF RaSULTS WITH DSRV SINGLE DEGREE OF FREEDOM EQUATIONS 

5iX Single pass identification runs were made with the EKF 
using each of tne single degree of freedom models in Table b2.1 for 
the purpose of proving that the working of the filter was independent 
of the model degree of freedom used and of the values of the parameters, 
The results of these identifications are shown in Table P4,15 for 
the DSRV surge, sway, heave, roll, pitch, and yaw single degree of 
freedom models, The sea oe and identifications conducted in each 
of these reduced models correspond to Blocks 1 through 6 in Figure Pl.1l. 
The primary results indicated by Table P4,15 are that the parameter 
are about 3% identifiable for 3% noises and that the EKF is a valid 
technique for each of the single degree of freedom DSRV models. 

This chapter has presented the results of a large number of 
extended Kalman filter identification runs for the DSRV surge equation. 


It has been found that not only must the filter be "tuned" to this 
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nonlinear differential equation by adjusting the vaiues of Q and R, 
but also it must have smaller time steps, more data points, and a 
better integration method than the model reference contouring tech- 
niquee However, once the filter is adjusted and given reasonably 
good initial estimates of the parameters, it is a far more accurate 
identification technique in the presence of large noise percentages 
Sen as tne model reference contouring technique, In addition, the 
extended Kalman filter in its general form may be used for the identi- 
fication of many parameters atonce, whereas the model reference con- 
touring technique looks at the parameters two at a time, 

This section has presented the detailed steps and resumes for 
the application of the techniques of model reference contouring and 
extended Kalman filtering to the ocean vehicle mathematical models of 
Section 2(M) by using, as examples, the single degree of freedom DSRV 
equation of motion. Now that these techniques have been validated 
for the single degree of freedom models, it may be reasonably expected 
that they will also work for more complex versions of the DSRV mathe- 
mivical model. The next step is therefore to present the structure 
and parameters for a structure-selective DSRV mathematical model with 
any combination of six degrees of freedom or vehicle effectors and to 
develop the digital computer programs necessary to simulate the 
vehicle using this model, Section 5(D) accomplishes this step, and 
then Section 6(C) uses this programming to study several selected 


Coefficients and parameters using multiple degree of freedom models, 
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SECTION 5 


THE DSRV MATHEMATICAL MODEL (D) 

Dl GENERAL OCEAN VEHICLE AND DSRV FORMULATIONS 

D2 OCEAN VEHICLE MODEL SUBROUTINE (OVMOD) 

D3. EFFECTOR SUBROUTINES 

D} GENERAL OCEAN VEHICLE AND DSRV GRADIENT FORMULATIONS 
D5 OCEAN VEHICLE DERIVATIVE SUBROUTINE (OVDER) 

D6 EFFECTOR GRADIENT SUBROUTINES 


D7 PROGRAM SIMPLIFICATIONS AND MODIFICATIONS 


A COMMENT REGARDING COMPUTERS: 
"DAZZLED BY THEIR ABILITY TO DO ELEMENTARY THINGS AT TREMENDOUS 
SPEEDS AND TO PUT THESE TOGETHER IN STRUCTURES OF DAUNTING COM- 
PLEXITY, SOME HAVE ALLOWED THE TERM "GIANT BRAINS* TO GAIN CURRENCY 
AND, SEDUCED BY THE SIREN SONG OF SO SENSELESS A SOPRIQUET, HAVE 
SURRENDERED THEIR BIRTHRIGHT OF RATIONAL THOUGHT FOR A POTTAGE 


OF PUNCHED CARDS.” - R. ARIS (A-7) . 


THE CENTRAL PURPOSE OF THIS THESIS IS THE DEVELOPMENT, PRESENTATION, 
DSRV UTILIZATION, AND ANALYSIS OF TECHNIQUES FOR THE IDENTIFICATION 
OF PARAMETERS IN AN OCEAN VEHICLE DYNAMIC MATHEMATICAL MOD@L, THIS 
SECTION PRESENTS THE DETAILED EQUATIONS FOR THE STRUCTURE SELECTIVE 
MODEL AND GRADIENT PROGRAMMING TO SIMULATE A GENERAL OCEAN VEHICLE 

WITH SUBROUTINES SPECIFICALLY TAILORED TO THE DSRV, THIS SECTION 15 


NECESSARY FOR THE UTILIZATION OF IDENTIFICATION TECHNIQUES ON THE DSRV. 
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CHAPTER D1 


GENERAL OCEAN VEHICLEI: AND DSRV_ FORMULATIONS 

The purpose of this chapter is to provide a bridge between the 
general ocean vehicle mathematical models in Section 2(M) and the 
specific DSRV mathematical model of the Lockhead Missiles and Space- 
eraft Company (B~9). To do this, the LMSC model must be converted 
to state space form and broken up into additive blocks of coefficient 
and effector equations. The resulting equations can then be seen to 
fit into the corresponding terms in equation Dl.1, which is discussed 
in Section 2(M). The nomenclature for the terms end coefficients is 


standard and is defined in references (S=9) and (A~1). 









é 
Ae = 


£(x.p) + fore(x susp) + Gu Dee 





Piel The DSRV DYNAMIC EQUATIONS 

The complete mathematical model for the DSRV is presented, with 
some variations, in the three references: (B-9), (T-1), and (B-2), 
' The equations to be used here are taken from (B-9), modified slightly, 


and presented here as equations DJ].2 through D1.7. 


surge 
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Yaw 


m [xg(¥ + xu = pw) - yg(a + qu ~ vv) ) + ior + - I,)pq = 


oy +N? v +N - N , “: 
iS r+ Nhe + Nog pq 4 al v Juv 4 Ne tat Yr jul + aan wp 
Nvg ao + Np fal ae) + N hal v ek ‘secondary + Neray + 
Nnroud * Norop v ae i Nast D1. 7 


Dl.2 THe DERIVATIVE CORFFICTENT MATRIX AND PRIMARY DERIVATIVES 


Expanding equations D1l.2 through D1.7 and collecting the deriva- 


tive teris leads to the vector representation in equation D1.8. 


derivative coefficient matrix A is then given by equation Dl.9. 


U ue 
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The terms remaining in the expanded equations Dl,2 throwen Dl, 7 
are designated the primed derivatives and correspond direetly to the 
forces and moments acting on the DSRV. These terms are presented 
here for completeness as equations Dl.10 through D1.15. 

Surge 
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Di.3 STATE SPACE FORM FOR THE DSRV EQUATIONS 


The general techniques for converting ocean vehicle mathematical 


models to state space form have been presented in Section 2 (M). The 


Conversion of the DSRV equations D1l.10 throush D1.15 and D1.8 to 

State space form is a straightforward application of those techniques. 
Thus, the terms uv w Pp qx become the first six states in the state 
vector x. Since the DSRV model contains only second degree coeffi- 
Cients and since an augmented state space model is desired, the 


Second degree coefficients (126 of them at most) become the next 
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126 states in x. In addition, the fact that the reverse mode coeffi- 
Bients ere in some cases different leads to the inclusion of the 
reverse mode coefficients as the next 126 states, This last step is 
not essential if other provisions are made within the model to include 
the reverse mode coefficients, 

The vector x is now of dimension 258 by 1 and includes the 
vehicle linear ana angular velocities and the vehicle forward and 
reverse mode second degree coefficients, Had linear, third degree, 
or other coefficients been present in the model equations, they 
would have Rien augmented into the general state vector, 

For ease of computation the second degree coefficients were 
included in a special order running from X,,, through Ns A general 
second degree coefficient can be represented as ae , where k, i, 
and j run from 1 through 6 in correspondence with uv wpqyr and 
XYZKMNWN. In addition, some of the coefficients are symnetric 

k 


k k 
M@aetnat X..= X., e nus, one order in which the X,. can be 
ij aa. ie) 


placed in x is in correspondence with equation D1.16, 


Ul 


(k, i, j) =i 4+ 5(§ -1)/2 4 n(n+1) (kh -1)/24n 
where: n= 6 Die 
The augmented state vector then appears as in equation Dl.17. 
If in addition all of the vehicle parameters other than the states 
and coefficients are lumped into one parameter vector p , the 
DSRV equations are seen to be in the form of equation Dl.l. 


iE 
x=[uvupqrX. ceoN. X rev eeoN rev] 
uu rr “uu rr Dl.17 


Bene 

















th the equations specified in this form and with the assumed 
jotermined values of tne coeiricients and parameters, it is now 
sible 10 simulate a general ocean vehicle with the DSRV as a 

cial case. Tne computations and structure selection are greatly 
jlitated by the state space form of the equations and by the 

ficient computation order. 

This chapter has presented the DSRV dynamic equations in state 

ce form. The detailed numerical values of the vehicle coefficients 
parameters are presented in Appendix Al. The next chapter presents 
> programming details for calcwlating a general ocean vehicle state 


rivative x in a structwre selective manner. 
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CHAPTER D2 


OCEAN VEHICLE MODEL SUBROUTINES (OVMOD) 

This cnapter presents a programming description and a flow- 
chart for structure-selectively calculating x in equation Dl.1l with 
and without noise. This subroutine is very general in that by 
specifying inputs and by including proper input subroutines, a very 
Jarge class of ocean vehicles may be simulated. The Fortran IV 
statements for this chapter are presented in Appendix A6. 

D2.1 INPUTS AND OUTPUTS OF SUBROUTINE OVMOD 

All of the inputs and outputs of subroutine OVMOD are either 
vectors or constants to permit variable dimensioning. Any numbers 
listed here are those used for the DSRV. 

OVHOD (ME, AV, XF, P, IN, U, NE, X, XN, XD, XDN, KB, L) 
Inputs: 
ME - Vector of 20 integers describing the vehicle effectors 
and parameter locations in vector P 
ME(1) - ME(9) = Model selectors of 0 or 1 depending upon 
ME(19) - ME(20) | 
whether a particular effector is not or is 
to be used. If 0, effector subroutine is 
not callea 
1 - Tanks (TANKS) 
2 = Secondary drag terms (SECAL) 
3 ~ Shroud (SHCAL) 
4) = Propellor (PRCAL) 


5 - Thrusters (THCAL) 
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20 


NE(10) - ME(18) 


10 


Li 


digs 


1h 


1g 
16 
1G 
18 


AV - Vector of 126 integers deseribing the absolute value 
characteristics of each of the second degree covfficirent 


terms in the mathematical model in the order of equa- 


Noise (XDIST) 


Constant terms (COCAL) 


Center of buoyancy ;/ 0 (GRAVT) 


Noiseless trajectory calculated in addi- 


tion to noisy one 


Vehicle angles are integrated angular 


velocities 


Vehicle angles are plotted as output 


Integer location of first effector 


parameter in vector P 
Tanks 

secondary drag terms 
Shroud 

Propellor 

Thnrusters 

Noise 

Constant 

Gravity terms 


General constants 


tion Dl.16; see Appendix A2 


le 
w~] =~ X. 


0 


ag al %5 
k 
- X35 xs * 5 


l- = De 5 


ZN 
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XF - Vector of 126 integers designating second degree cocffi-~ 


IN = 


NE = 


cient a as a function to be evaluated instead of a 
constant and designating its functional branch in sub~ 
routine XFUNS which is used in subroutine XDCAL: see 
Appendix A2 
Vector of all vehicle and environmental parameters with 
initial locations specified by ME, total of 587 in DSRV; 
Appendix Al 
Vector of integers to be used as starters for the noise 
generation subroutines (6) 
Vector of inputs to the ocean vehicle (18) 
U(1) = U(7) = Liquid loadings of the 7 tanks in lbf. 
U(8) = U(9) = Shroud angles in radians (DP, DY) 
U(10) = U(11)- Propellor RPS and RPS/SEC (n, n) 
Uil2) - U(i5)- Thrusters RPS (yf, ya, of, za) 
U(16) - U(18)~ Vehicle Angles (PHI, THETA, PSI) 
Vector of integers describing the number of each type of 
input and its location in input vector U and describing 
some effector parameter group characteristics in P 
NE(1) = NE(10) - Number of types of effectors and loca- 
tions in input vector U 
1 - Tanks (7) 6 = Tanks location (1) 
2 - Shroud (2) 7 = Shroud location (8) 
3 - Propellor (2) 8 ~ Prope location (10) 
4 ~ Thrusters (4) 9 = Thr. location (12) 


Angles location (15) 


5 - Angles (3) 10 
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XN = 


OUTPUTS : 


XD « 


XDN ~ 


NE(11) + NE(27) ~ Number of straight line regions in the 
parametric descriptions of the shroud 
and thrusters 

11 - Shroud lift regions (5) 
12 + Shroud drag regions (10) 
a> 18 Thruster regions (8, 8, 3, 5,7, 7) 
19 - Noise parameters (6) 
20 ~ Shroud lift derivative regions (9) 
21 - Shroud drag derivative regions (15) 
22 - 27 ~ Thruster derivative regions (11, 9, 5, 
elo 9) 

Vector of al] vehicle states and augmented forcward and 

reverse mode coefficients, noiseless (258), Appendix Al 

Vector of all vehicle states and augmented foreward and 

reverse moce coefficients, with added and integrated 

noise (258) 

Integer 1 < KB < KS describing the number of states in the 

model structure, KS = 6 for DSRV 

Vector describing the individual states (total of KB) in 


the model structure 


Vector of primary state derivatives selected by KB and L 
without noise (maximum of 6) 
Vector of primary state derivatives selected by KB end L 


with added and integrated noise (maxinun of 6) 
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D2.2 PROGRAMMING DESCRIPTION AND FLOWCHART OF SUBROUTINE OVKOD 

the purpose of subroutine OVMOD is to calculate the noisy and 
noiseless state derivatives, x and = » in a structure selective 
manner. Thus, subroutine OVMOD solves equation D2.1, which represents 


a large class of ocean vehicles, Equation D2.1 is a subcase of 









+ + X 


, X 
~eray © = 


fe tT Agist 
D2. 








equation Dlel. The summations may also be written j = 1, 6 and 

me 1, je The structure selective aspect of solving equation D2.1 
comes from allowing i, j, and k (where x = x,, k = 1, 6) to take on 
may cone Velucs of the desired model. 

The programming necessary to solve DZ,1 structure selectively 
begins with the establishment of the centcr of gravity, weight, 
buoyancy, and center of buoyancy. Normally, tne center of buoyancy 
is taken to be the coordinate system origin. <A new center of gravity 
and vehicle weight are calculated based upon the loadings in the tanks, 
Then the C. G. and W are used to calculate the gravity forces on the 
vehicle and the values of the A matrix. 

At this point in subroutine OVMOD, prevision is made for the 
Calculation cf two separate vehicle trajectories, a noisy and a 
noiseless one. The two paths are almost identical except that in 
the noisy path, moisy variables are used and disturbances are added 
to the forces. The basic solution in both paths involves calcula~ 


tion of the shroud forces, calculation of coefficient forces and 
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other effector forces using XALCAL, and solving the simultaneous 
etion iyo for’ x. 
An abbreviated flowchart for subroutine OVHOD is shown in 
figure D2.l1. 
D2,3 SUBROUTINE XDCAL (ME, AV, XF, P, PG, U, N, X, XD, KB, L, XK) 
Subroutine XDCAL conputes a selected, untransformed linear or angular 
acceleration for a general ocean vehicle, XDCAL is a general sub-~ 
routine for second-degree coefficients, but it uses subroutines specific 
to the DSRV. 
The inputs and outputs to XDCAL are the same as those to sub- 
routine OVMOD except for PG, N, and Ke XDCAL operates basically by 
PG - Vector of parameters describing the vehicle weight (1), 
buoyancy (5), center of gravity (2 - 4), and center of 
buoyancy (6 = 8) 
N - Same as NE in OVMOD 
K - Index of the desired linear or angular acceleration, 
L<K< KS 
summing the second-degree coefficient texms using the coefficients 
Calculated by XFUNS and then by adding on the forces and moments of 
the desired effectors, A listing of the coefficient functions and 
their selection constants is given in Appendix h2. 
D2.4 SUBROUTINES ACALC AND SECAL 
Subroutine ACALC is used by OVNOD to calculate the derivative 
coefficient matrix, A, given by equation DL.9. These values are 
Calculated selectively using the vehicle parameter vector P and the 


Gfavity and buoyancy vector PG. 
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Subroutine SECAL is used by OVMOD to calculate the cross-flow 
Por secondary-cdrag forces and moments encountered when the vehicle 
es with v, Wy, q, Or xr. ‘The secondary drag equations are highly 


linear equations involving coefficients Y (24) and z (48). 


WH 
se equations are presented in Appendix A3. 
Both subroutines ACALC and SECAL are specifically written for 
> DSRV. 

The Fortran IV statements for subroutines OVMOD, XDCAL, XFUNS, 
CAL, and ACALC are included in Appendix A6. Tne next chapter 


cribes the DSRV effectors and presents the input-output descriptions 


the effector subroutines. 
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CHAPTER D3 


EFFECTOR SUBROUTINES 

The subroutines which are called by OVMOD as effectors are: 
TANKS, GRAVT, SHCAL, PRCAL, THCAL, COCAL, and XDIST. Each of these 
effectors will be described and its equations presented, The Fortran 
TV subroutines for the simulation of cach effector are presented in 
Appendix A7. The information presented in this chapter is not 
intended to be a complete description of each effector, but merely 
an aid in understanding and using the subroutines. For more informa- 
tion on the development of these equations and more details of the 
effectors, see (B-9) and (B-2), 
D3.1 TANKS 

Tanks equations for vehicle center of gravity 


oe 7 Xs + oe ei Xs 


oc | : 
DW, too, 


same form ror Yo and. Za. except Ys and a are used 


D361 


Where W,. = equilibrium tank loadings 
ou, = Wan Ws = jneremental tank loadings 


W 
O 


W 


Hf 


» Ws 5 = equilibrium vehicle weight 


H 


Wo ~~ 2 6 We =: vehicle weight 
Xss¥y0%3 = Neeson of C.G, of i*th tank 
mike (Pp, My U, NT, PG) 
P ~ Parameter vector containing the tank equilibriun 
loadings and the tank locations in the order 


(starting at P(M)) of Wa Xge Sge By 
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M = Location of first tank parameter in P 
U + Input tank loadings starting at u(1), Hy 


Number of Tanks 


za 
oe 
: 


PG =~ Gravity and Buoyancy Vector, described in D2, 
Subroutine TANKS is valid for a general systen of NT tanks, 
Dee GRAVE 
Gravity forces and moments equations Doec 
= ~(W - B) sin 0 


(W ~ B) cos © sin @ 


Hi 


Hf 


(W - B) cos © cos # 


a 
b 


C Ge W~ y, B) cos @ cos § - 


(z. W Zs, B) cos 6 sin @ 


a(x, W-x 


M P 


if 


B) cos 9 cos § - 


B B) sin 0 


Ng = (2, W - x, B) cos @ sin 9 + 


(z,, We 2 


(yo W- yp B) sin 0 
Where B = vehicle buoyancy 
0, g = vehicle angles with respect to equilibriun 
These equations simplify when %pr Ype Zp @re BELO. 
GRAVT (M, A, N, P, X, K, L) 
M - Center of Buoyancy = 0 indicator, M = 0 means C.B. = 0 


A 


Input Vehicle angles in radians 
N - Location of first vchicle angle in vector A 
P - Same as PG vector in D2,3 


X ~ Output forces and moments calculated 
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K - Number of teris to be calculated, same as KB in OVMOD 
bem W@cctor of indices of terms to be calculated | 
D3.3 SHCAL 
The shroud is, from a simulation standpoint, the most complex 
effector on the DSRV. The shroud equations are developed in 
reference (B-9). Tne shroud angles are 6p and 6y. In the foreward 
mode (u > o) the angles are defined such that +6p produces -Z and 
-¥ while +6y produces +Y and -N. The shroud is almost ineffective 
for u < 2 ft./sec. 
Shroud Equations 


Ud cos 6y sin 6y 0 cos 6p O -sin 6p 
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3 


£5 


angle between incoming 
centerline 

shroud location on the 
fluid specific gravity 


surface area (14.64) 


ff 


velocities of shroud in shroud coordinates 


flow and snroud 


vehicle (-24.59 ft.) 


(1.994) 


shroud lift coefficient, calculated by 


RGCOM using a series of connected straight 


lines for different regions of c., there 
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are 16 parameters beginning at P(103), 
6 ranges, 5 slopes, 5 intercepts which 
are used by RGCOM to calculate Coe straight 


lines approximate curves in (B-9) 


Cp(ag) =x shroud drag coefficient, calculated sane 


y2 


as C (a,), 31 parameters beginning at 
P(119), 11 ranges, 10 slopes, and 10 
intercepts, These straight lines for 
Cis Cy are approximations for the curves 
given in reference (B~9). 


2 2 2 


meabe(P, HM, X, U, N, NS, NL, ND, XS, KB, L) 


P 


hi 


KB, L 


vehicle parameter vector, same as in OVMOD 
location of first shroud parameter in P 
vehicle augmented state vector 

vehicle input vector 

location of first shroud angle in U (8) 
number of shroud input angles (2) 

number of regions in lift eee Ce (5) 
number of regions in drag coefficient Cp (10) 
output vector of shroud forces and moments 


structure selection inputs as in OVNOD 


The shroud eguations are so structured that it is best to cal- 


Culate all selected shroud forces at once rather than independently. 
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The subroutines used by SHCAL are ASCOM, RGCOM, UTCOM, and SIMQ, 
Syproutine ASCOM computes the shroud angle Gis using equation D3./), 
Subroutine RGCOM is used to compute the straight-line approximate 
values of the lift and drag coefficients, C. and Cp. Subroutine 
UICOM computes the product of the three matrices in equation D3.3. 
Subroutine SIMQ is a simultaneous equation solver from reference (I-1), 
the IBM/SSP and is presented in Appendix A4, 

D304 PRCAL 

The propellor equations are of similar structure for each degree 
of freedom but have different parameters depending upon the region 
of operation. 

Propelior Equations, propellor inputs are n, n 


ovr x FL 


Pp p 
oe = Wo x q | 
Regions for Xp i equations - Parameters 
le=u>0O, n/u> -0.21 o 4 Zee 
2=2u>0, n/u < -0.21 a 5 ee 
32u<0, n>0 6 7 8 32 
bheu<0, n< 0 9 10 #2121 be 
Parameters located at M + Index 
x = Py nini + P, un + P, eae Pao n oe + 2)? 
D313 


ol 
= pe 2 aN o P ° 
K Pig nint + Pao un + Pyg um + Pe. n (vo + ws) + Py fh 
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Region Parameter indexes 


1 a iP 1s 6338 
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i)! N, = Pio n - Dons 
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Parameter indexes 


Region AG N Xx M 
. Se ns 


i hz 30 14 28 
2 13. 32 0262«215~—=O29 
Where; 


x = propellor location on vehicle, P(M + 36), (-25.5) 


=) as) 


ff 


propellor rotation, rps 


propellior acceleration, rps” 


se 
{! 


PRCAL (P, M, X, U, N, NP, XP, K) 


P, M, X, U, N - same as in SHCAL, except N = (10) 


NP - number of propellor inputs (2) 
XP ~ output of propellor force or moment 
selected by K 


K - index of desired force or moment 


yi 





D3.5 THCAL 


For the purposes of this thesis, the stcady state (dn/dt = 0) 


thruster equations are used, 





Thruster equations (B-9) D3.17 
Ken = 2 Xn on ay a2 
Yon = Yen yf + Yon ya n=f, a foreward, aft 
Zen = 4th ot * 2th za 
Ki, = 0 
Bi > * Meh on 
Me, = = Neh inn 
Individual equations D3.18 
Aen mt = nit Ts a = Nea Nz Ty 
ena na Ty Men of = Piso "ee [Por] My 
th ye | YE ["ye| a Mth za Pua 2a Pxa| * 
Tth ya = ya > ya ue Meh yn mee Dyn Mn | 
4th of = "ge era aa Neh yf ~ P23 OVE Pyz| a1 
aya 128 ye "ya 2m ethian © 125 Gene leee 
Where: 
m= y, 2 ~- thruster directions 
west sa) ¢ tore and aft thruster sets 
T; - thruster force coefficients approximated as 
straight lines and calculated using RGCOM, 
(B-9) curves 
M, - thruster moment coefficients, calculated same as T; 


All coefficients are functions of A = u/ |nf 
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mem (P, M, U, N, X, XT, K) 


Py My U, XN - same as in SHCAL, except HN = (22) 

XT - output thruster force or moment selectad 
by K 

K - index of desired force or moment 


D3.6 COCAL 
COCAL (P, M, X, XC, K) Constant forces and moments selected from P 
P, M, X, K - Same as previous effectors 
XC - selected constant force or moment 
D3.7 XDIST 

subroutine XDIST is a general disturbance generator nen uses 
subroutines GAUSS and RANDU from the IBN/SSP (I-1). 

moloT (i, P, M, X, Ky, N) 

Lt - vector of noise generation integers used by RANDU 
P,M - same as previous effectors 

X = output selected noise force or moment 

K = selection index 

N = number of possible forces and moments (6) 

The Fortran IV statements for subroutines TANKS, GRAVT, SHCAL, 
PRCAL, THCAL, COCAL, XDIST, ASCOM, RGCOM, and UTCOM are included in 
Appendix A7. Subroutines SIMQ, GAUSS, and RANDU from reference (I-1) 
are included in Appendix A4, 

These three chapters, Dl, D2, and D3, have presented the equa- 
tions End the input-output descriptions of the subroutines necessary 


to Simulate the DSRV in any selected combination of six degrees of 


=27) = 









The next three chapters, D4, D5, and D6, present the equa- 
d the subroutine descriptions necessary to calculate the 
the DSRV forces and moments selectively with respect to 


e states, coefficients, and parameters. These gradient 


s are used in Kalman Filtering. 
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CHAPTER D4 


GENERAL OCEAN VEHICLE AND DSRV_ GRADIENT FORMULATIONS 

The state space gradient for an ocean vehicle is essential to 
almost all identification techniques, It is required for propogation 
of the error covariance matrix in a Kalman Filter and is required 
for best estimate calculations in many techniques which linearize 
the state equations about a certain trajectory, Given a general 
state space system as in equation D4,1, the desired gradient is given 


by equation D4.2. 


ba= £ (x, u) DY. 
dx of (x wy) 
made ~ dx mec: 


The gradient can now be expressed in terms of a general ocean 
vehicle equation Dl.1 repeated here as D4.3, The gradient of D4.3 
is given by D4.4 for the case in which A is a constant matrix. For 
the case in which A(p) is dependent upon vehicle parameters, equation 
DY.5 must be used, and calculation of the A derivative term does 


appear to be straightforeward, as seen in equation D4t,6, 








A(p) x = oe p) + Lore OF Uy p) $C wi Di. 3 
ax fdx| [Of dfore | IL doer Di! 
ide)" [et Je det de - 
Beas) [4702 dface)! 

dx ' dp} ~ 2 ae 
pat Gq + Lert 41- G w) Le Le (jf dfore) D4. 5 


Op dp” dp 
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dp 


_ gradient subroutine in this thesis uses equation D4.4 and does 












ea] - ak -) 
Lane ; 1 (JA) A Dy.6 


permit identification of those parameters in the A-matrix (added 

; and moment of inertia terms) with Kalman filtering. 

The calculation of the gradient matrix for a general ocean 

Micle now proceeds by applying equaticn D4./) to equation D2.1 and 

n developing the equations and programming for the calculation of 

» coefficient and effector derivatives, The details of the equations 
| programming for the gradient routines are presented in chapters 


and D6. 





CHAPTER D5 


OCEAN VEHICLE DERIVATIVE SUBROUTINE (OVDER ) 

This chapter presents a programming description of the sub- 
routines for structure~selectively calculating the gradient matrix F 
in equation D4.2 using equations. D4,4 and D2.1.. The gradient sub- 
routine (OVDER) is designed to be a companion to the general ocean 
vehicle subroutine (OVMOD), Many of the inputs and calculation 
techniques in both are the same, except that OVDER has a much greater 
computation task to perform than OVMOD. The Fortran IV statements 
for OVDER and its subroutines are presented in Appendix A8, 

D5.i INPUTS AND OUTPUTS OF SUBROUTINE OVDER 

As in OVMOD, all of the inputs and outputs are in vector or 
constant form to permit variable dimensioning. Numbers listed here 
are those used in the DSRV studies, 

OVDER (ME, U, AV, XF, KF, LF, KB, L, X, KP, LP, P, F, NF, NE) 

Inputs: 

ME, AV, XF, P, U, NE, X, KB, L ~ Same as OVMOD, Chapter D2 

KF - Integer 0 < KF < 126 describing the number of second- 
degree coefficients to be used in the gradient matrix 
Calculation 

LF ~ Vector describing the indices of the second-degree 
coefficients used in the gradient 

KP ~ Integer 0 < KP < 126 describing the nunber of 
parameters of vector P to be used in the gradicnt 
matrix calculation 

LP = Vector describing the indices of the parameters used 
in the gradient 
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Outputs: 
F = Output gradient matrix of dimension KB * Nir 


(KB = number of selected vehicle primary states, 
maximum of 6 for DSRV, u, v, x, p, q, ©) of the 


form of equation D5.1 


» dX 


‘eee 


Qe 
ne 


ce eee. OX 
ee oa a 
Fel ) . 
ON we. ON 2h . oN 
pu or Xn pes 


/ 


1. OF 
DP, 


NF - Output constant KB < NF < 200, NF = KB + KF + KP, 
describing the number of columns in F 
D5.2 PROGRAMMING D&SCRIPTION OF SUBROUTINE OVDER 

The calculations necessary to the computation of the gradient 
matrix F in equation D5,1 naturally divide themselves into three 
froups: calculation of partials with respect to prinary Seales 
With respect to second-degree coefficients, and with respect to 
parameters, As in OVMOD, all of the programming in OVDER must be 
structure selective. However, the structure selectivity in OVDER 
must apply not only to the states but also to the second-degree 
coefficients and to the parameters, 

The programming necessary to compute the gradient matrix F 
involves utilizing subroutines XDDER, XFDER, and XPDER to calculate 
the three groups of partial derivatives in F. Subroutine OVDER 
begins, as in OVMOD, by calculating the vehicle center of gravity, 
weight, buoyancy, and center of buoyancy, These values are used to 


compute the A-matrix which is then inverted selectively depending 
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upon its dimension. 

Next, a series of steps sets up the structure and parancters 
for calculating the KB * KB derivatives with respect to the primary 
states by subroutines XDDER, SEDER, PRDER, THDER, and SHDER, ‘These 
resultant derivatives are then compressed into the vector F, 

The following KB * KF derivates with respect to the second~ 
degree coefficients are calculated by XFDER and compressed into F, 
and the KB * KP derivates with respect to the parameters are calcu- 
lated by XPDER and compressed into F, The final step in OVDER is 
then the derivative transformation which consists of multiplying F 
by av), 

Subroutine OVDER uses the three general~utility Subrourimees 
A3BINV, MINV, and GuPRD, Subroutine A3INV is a self~explanatory 
routine for inverting a general 3 * 3 matrix. Subroutine MINV is an 
Meee mavrix inverter from the IBM/SSP (I-i), and GMPRD is a matrix 
multiplier from the IBM/SSP, These IBM/SSP routines are presented, 
for the convenience of the reader, in Appendix A4, 

The following subroutines used by OVDER are also used by OVMOD 
and are described in Chapters D2 or D3: TANKS, ACALC, XFUNS, SECAL, 
RGCOM, and UTCOM. The next portions of this chapter describe sub~ 
routines XDDER, XFDER, and XPDER =- the three main subroutines of OVDER, 
D5.3 SUBROUTINES XDDER AND SEDER 

subroutine XDDER calculates the partial derivatives with respect 
to the primary states of the terms wider the double summation in 
equation D2.1 and furnishes them for inclusion into the first KB * KB 


terms of F in equation D5.l. 
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Mame ny, X®, P, PC, X, DX, K, M, KB, L) 
AV, XF, P, X, KB, L = Sane as OVMOD, Chapter D2 
PC ~ Same as PG in XDCAL Chapter D2,3 
DX - Output vector of partial derivatives with respect 
to states 
K - Index of the term to be differentiated, 1 < K < KS 
M - Index of the state with respect to which the partial 
aerivative is taken, 1 <M < KS 
Subroutine SEDER calculates tne partial derivatives of the Rees 
berm in equation D2.1 with respect to the primary states, This is 
done by branching to the proper partial derivative function based 
upon input index K, These functions represent all of the statewise 
partial derivatives of the secondary drag functions in Appendix A3. 
SEDER (P, M, X, DxS, K) 


P,X ~ Input paraneter and state vectors 
M = Location of first secondary drag eee in 2) inp 
DXS - Output of selected derivative of the K-th tern 
K - Input index of desired secondary drag derivative 
The other subroutines used for calculating derivatives with 
respect to the primary states are the effector routines: PRDER, 
THDER, and SHDER, These subroutines are described in Chapter DS on 


effector gradient subroutines. 


D5.4 SUBROUTINE XFD&R 





Subroutine XFDER calculates the partial derivatives with respect 


to the second-degree coefficients of the terms under the double 
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summation in equation De.l.e ‘nese Kb * KF terms are then compressed 


by OVDER into the gradient vector F, The XFDER paxriial derivatives 


are Galculated using a lengthy selection procedure and using sub- 


routine XDFNS which gives the derivatives of the second-degree co- 


efficient functions with respect to the second-degree coefficients, 


Subreutine SECAJ 


respect to those 


is used for calculating partial derivatives with 


two second-degree coefficients used in the secondary 


drag calculations, 


emia AV, XP, P, PC, X, XPD, KF, LF, KB, L, MS) 


AV, XF, 


PC 
KF, LF 
MS 


XFD 


BONS (P, X, 


lee x o— 
K ~- 
T = 
D ¥ 
N a 


P, X, KB, L = Same as OVMOD, Chapter D2 


- Same as PG in XDCAL, Chapter D2.3 


Same as OVDER, Cnapter D5.1 


Location of first secondary drag parameter in P 


Output vector of partial derivatives with respect 
to the second-degree coefficients 

een ) 

Same as OVMOD, Chapter D2 

State vector index of desired second-degree 
coefficient 

Same as XF vector in OVMOD, Chapter D2 

Output derivative of second-degree coefficient 
function with respect to the selected second- 
degree coefficient 

Output zero indicator, N = 0 when D=0., and 


N= 1, when D ;# 0. 


eas 





D5,5 SUBROUTINES APDER AND SEDEP 

Subroutine XPDGK calculates the pactial cerivatives with re- 
gpect to the parame vers of the terins in equation D2.1. These KB * KP 
terms are then compressed by OVDER into the gradient vector F, 

Provisions have not been made to calculate derivatives with 
respect to all of the parameters in vector P, Derivatives are not 
Calculated with respect to the parameters in the A-matrix, This 
would require implementation of equations D4.5 and DY.6 and has not 
been done in this thesis. Derivatives are not calculated with 
respect to the parameters in the second-degree coefficient functions, 
the tanks parameters, the shroud parameters, the noise parameters, 
the variable parameters, the mass of the vehicle, or the acceleration 
of gravity (Appendix Al). 

Derivatives are calculated with respect to the secondary drag 
parameters’ (SEDEP), the propellor parameters (PRDEP), the thruster 
parameters (‘THDEP), and the constant terms parameters, Subroutines 
PRDEP and THDEP are described in Chapter D6. 

XPDER (P, ME, U, NE, X, XPD, KP, LP, KB, L, NT) 

P, ME, U, NE, X, KB, L ~ Same as OVMOD, Chapter De 

XPD - Output vector of partial derivatives with respect 
to the vehicle parameters 

KP, LP - Same as OVDER, Chapter D5.1 

NT - Input vector describing thruster derivative 


numbers of regions in P 
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Subroutine SEDEP is used by XPDER to calculate the partial 
derivatives of the untransformed vehicle forces and moments with 
respect to the secondary drag parameters, These derivatives are 
calculated by branching to the proper partial derivative function 
based upon input index K. These functions represent all of the 
parameterwise partial derivatives of the secondary drag functions 
in Appendix A3. 

meee iP, M, X, XS, K, J) 

P, X =~ Input parameter and state vectors 


hi 


> Location of first secondary drag parameter in P,input 


XS = Output of selected derivative of the K-th term with 
respect to the J-th Rector 

K ~ Input index of the K~th vehicle force or moment tern 

4 - Input index of the J-th secondary drag parameter 


This chapter has presented a basic description of subroutine 
OVDER and its associated primary subroutines XDDER, XFDER, and XPDER. 
The Fortran IV statements for OVDER and its associated subroutines 
described in this chapter are presented in Appendix A8. The next 
chapter presents a basic description of the effector gradient sub- 


routines which are used by OVDER in calculating the gradient matrix FP, 
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CHAPTER D6 


EFFECTOR GRADIENT SUBROUTINES 

The subroutines which are called by OVDER as effector gradient 
Subroutines are SHDER, PRDER, THDER, PRDEP, and THDEP, A basic 
description of each of these subroutines will be presented in this 
chapter as an aid in understanding and using these subroutines, The 
Fortran IV statements for these subroutines are presented in 
Appendix A. 
D6.1 SUBROUTINE SHDER 

subroutine SHDER is mathematically the mest complex vehicle 
Subroutine in this thesis, The complexity arises from the two 
transformations and the nature of the shroud anguler functions. 
SHDER computes the partial derivatives of the shroud forces and 
Moments with respect to the primary vehicle states. These partial 
derivatives represent, quite literally, the partial derivatives of 
Cquations D3.3 through D3.12. <A coiplete description of SHDER is 
not presented here, but enough of the partial derivative equations 
are presented to facilitate understanding and utilization of the 


Subroutine when compared with SHCAL in Chapter D3. 3. 
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D6. 3 


D6. +4 


D6.6 


D6.7 


DS.8 
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Equations DS5.1 through D6,.12 in conjunction with equations D3.3 
through D3.12 represent the essence of the shroud and shroud derivative 
Calculations. Suodroutine ASDER is a grouping and calculation of several 
of the 0. equations for convenience, Subroutine UTCOH computes the 
product of the three matrices in equation D3,3. Subroutine RGCoI4 
is used by SHDER to compute the lift and drag coefficients along with 
their derivatives with respect to oe Subroutine A3INV is a general 
3 * 3 matrix inverter, and subroutine GMPRD is a general matrix 
multiplier from the IBN/SSP. 

SHDER (P, M, X, U, N, NS, NL, ND, NDL, NDD, XSD, KB, L) 

P, X, U, KB, L - Same as OVMOD, Chanter [2 


M - Location of the first shroud paramcter in P 


= 
{ 


Location of the first shreud angle in U 


NS - Number of shroud angles 


= 
oe 
2 


Number of lift coefficient straight line regions 
ND = Number of drag coefficient straight Jine regions 
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HDL ~- Number of Lift coefficient derivative straight line 
regions 
NDD ~ Number of drag coefficient derivative straight line 
regvons 
XSD - Owtput shroud derivative vector, equation DS,1 
D6.2 SUBROUTINE PRDER 
Subroutine PRDER computes the dexivatives with respect to the 
primary states of the propellor forces and moments. These derivatives 
are calculated by branching to the proper functional partial deriva- 
tives of equations D3.13 through D3.16, 
PRDER (P, M, X, U, N, NP, XP, K) 
P, M, X, U, N - Same as in SHCAL, Chapter D3, except N = (10) 
NP ~ Number of propellor inputs (2) 
XP = Output partial derivative OX no Je xs 
K - Indexes of desired partial derivatives, 1 < K < 36, 
Sy ee 1 + 6( 5 ~ 1) 
D6.3 SUBROUTINE THDER 
subroutine THDER computes the derivatives of the thruster forces 
‘and moments with respect to the primary states of the vehicle. These 
derivatives are calculated by branching to the proper partial deriva- 
tives of equations D3.17 and D3,16 and then by using subroutine RGCOM 
to compute the thruster coefficient derivatives as straight line 
approximations of the curves in reference (B-9). 
mean (P,9N; U, N, X, XT, K) 


Py, U,"X - Same as SHCAL, Chapter D3 
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NW - Same as NT in Arvin, Chapter D5, 5 
XT ~- Output partial derivative x lx, 
K - Same as PRDER, Chapter DS.2 
D6,.4 SUBROUTIN# PRDEP 
Subroutine PRDEP compuves the derivatives of the propellor forces 
and moments with respect to the selected propellor parameters. ‘These 
derivatives are calcvlated by branching to the proper functional par- 
tial derivatives of equations D3.13 through D3.16, 
mer (P, M, X, U, N, NP, XP, K, J) 
P, M, X, U, N - Same as in SHCAL, Chapter D3, except N = (10) 


NP - Number of propellor inputs (2) 


a i a 
XP ~ Output partial HEE SIDS OE (eh 


K Index of force or moment 


J - Index of parameter 
D6.5 SUBROUTINE THDEP 
subroutine THDEP computes the derivatives of the thruster forces 
and moments with respect to the selected thruster parameters, These 
derivatives are calculated by branching to the proper partial deriva-~ 
tives of equations D3.17 and )3.18 or else by using subroutine RPDER 
to Calculate the parametric derivatives of the straight line approxi- 
mations of the thruster coefficients, 
mesr (P, H, U, N, X, XT, K, J) 
P, M, U, N, X - Same as THDER, Chapter D6,3 
XT - Output partial derivative 2/2? 
K,J - Same as PRDEP, Chapter D6,/ 
This chapter has presented a basic description of the DSRV 


effector gradient subroutines, The Fortran IV statements for the 


-292- 








radient subroutines described in this chapter are presented 





4x AQ. The next chapter describes methods for nodifying 
the DSRV subroutines for use with other ocean vehicles and 
ts several programming simplifications which could be applied 


model subroutines, 
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CHAPTER D7 


PROGRAM SIMPLIFICATIONS AND MODIFICATIONS 

The purposes of this chapter are to describe the modifications 
necessary to OVHOD and OVDER for calculation of vehicles other than 
DSRV and to recognize that these subroutines have several possible 
program simplifications. 

D7el PROGRAM SIMPLIFICATIONS 

Subroutines OVMNOD and OVDER along with their associated subroutines 
were written and debugged separately, directly, and suboptimally. As 
Wratten, however, they do their jobs, and so the author has not 
devoted any extra time to “cleaning up the code," reducing the nunber 
of cards, or speeding them up. 

The most obvious and potentially profitable work to be done is 
the combination of OVMOD and OVDER into a single subroutine. Several 
of the functions computed by each are identical, and many of the 
Variables computed by one can be used by the other. Some provision 
_ Should be made in the combined subroutine to allow deferring calcu- 
lation of the gradient when the model is to be used in a model reference 
framework. 

Another set of possible simplifications arises from the fact 
that all of the couations were written out completely in several 
cases and not combined by type. An example of this is in ACALC, 
where AC = 0, appears many times and could be written only once with 
proper changes in the initial conditional GO TO statement numbers, 
several other subroutines to which this simplification would apply 


are: XFUNS, COCAL, XDFNS, XPDER, and PRDER,. 
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In several subroutines, there are sections containing the sane 
or arly the same sequence of steps. ‘These could perhaps be simpli- 
fied by making those sections into subroutines, For example, in 
subroutine THCAL there are several groups of about 20 statements 
each which have somewhat the same structure end could be rewritten 
into a subroutine. The noisy and noiseless sections of OVMOD could 
also be combined into a single subroutine. 

it is now evident to the author that there are several sub- 
routines which contain unnecessary conditional GO TO statements and 
ISW indicators. An example of this is in subroutine SECAL, where 
the first conditional GO TO (2,3) ISW is unnecessary if in the two 
preceeding statements the IS = *s were changed to GO TO 's, In 
fact, one of the two preceeding statements could also be dropped. 
This type of simplification is evident eJsewhere in SECAL as well 
as in several other subroutines, 

D7.2 PROGRAM MODIFICATIONS FOR OTHER OCEAN VEHICLES 

The keynotes of OVMOD and OVDER as written are structure selectiv- 
ity, second-degree coefficients, and DSRV effectors. Any potential 
user of these subroutines who does not require structure selectivity 
for reducing the parameter space would be well advised to write his 
own OVMOD/OVDER rather than trying to modify this one. The entire 
fabric of these two subroutines is woven from structure selectivity 
Statements and a considerable percentage of the computation time 
(est, 20-30%) is spent selecting structure. 

Any potential user who requires linear, third-degree, fourth- 
degree, etc., coefficients or who does not require second-degree 


Coefficients would have to rewrite XDCAL, XDDER, and XFDER based upon 
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the requireuwents of nis model. it is anticipated that the progran- 
ning mecessary to include additional coefficients will be straight- 
foreviard extension of the techniques used for the second-degree 
coefficients. 

The DSRV effector subroutines will not be applicable to most 
other ocean vehicles. The TANKS, GRAVT, and COCAL could probably 
be used directly for any ecean vchicle, but the SHCAL, SECAL, PRCAL, 
and THCAL (shroud, secondary drag, Pro ooinon: thrusters) subroutines 
are specific to the DSRV, Anyone wishing to use OVMOD/OVDER should 
write effector subroutines specific to his vehicle and include param-~ 
eters and calling statements in OVIiOD and OVDER, 

SECTION 5(D) SUMMARY 

This section has presented the detailed equations for calcula- 
tion of the time derivatives and their gradients of the linear and 
angular velocities of a general ocean vehicle. A subroutine for 
calculating the linear and angular accelerations (OVMOD) has been 
presented and its use explained, A subroutine for calculating the 
gradient with respect to states and parameters of the linear and 
sangular accelerations (OVDER) has also been presented and its use 
explained. Effector subroutines specific to the DSRV have been 
included for both OVMOD and OVDER and explained. ‘The Fortran IV 
Statements for these chapters are found in Appendices A6 = A9. 

The next section 6(C) presents the programming and analysis 
for utilization of these model and gradient subroutines in the iden- 
tification and identifiability studies of the DSRV coefficients and 


parameters, 
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TIFICATION STUDIUS OF THE DSRV DYNAMIC CORFPICINNTS (Cc) 


[AIN 6 * 6 IDENTIFICATION PROGRAM DESCRIPLION AND SRA 
TRIALS (MAIN) 


MODEL REFURENCK CONTOURS FOR SELECTED DSRV 6 * 6 PARAMETERS 


DESCRIPLION OF SEVERAL SUBROUTINES FOR US# IN THR MAIN 
PROGRAM 


THE PURPOSE OF COMPUTING IS INSIGHT, NOT NUMBERS," - 


R. We. HAMMING (H-5) 


[S SECTION PRESENTS A DESCRIPTION OF AND SOM# RESULTS FROM A 
WCTURE-SELECTIVE SIX DEGREE OF FRESDOM IDENTIFICATION PROGRAM 
ICH USES THE DSRV MODEL OF SECTION 5(D). TH COMPUTER RUNS ARE 
SIGNED TO SHOW HOW THS PRIMARY VEHICLE BEHAVIOR CHANGES AS MORE 
GREES OF FREEDOM ARE INCLUDED AND TO SHOW THE MODEL REFERENCE 
NTOURS OF SEVERAL SELECTED DSRV COEFFICIENTS AND PARAMETERS IN 


LTIPLE DEGREE OF FREEDOM MODELS, 
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CHAPTER Cl 


MAIN 6 * 6 IDENTIFICATION PROGRAM DESCRIPTION AND SEA TRIALS (MAIN) 

The extensive studies of Section 4(P) have shown that the model 
reference contouring and extended Kalman filtering techngiues are 
valid for the DSRV single Aeese of trecdom equations, This section 
shows that the model reference contouring technique is valid for the 
DSRV in one through six degrees of freedom for seal eee coeffi- 
cientse ‘The DSRV mathematical model has been presented and its sub-~ 
routines described in Section 5(D); this model is used in the main six 
degree of freedom, structure-selective identification program developed 
for the studies of this section, 

This chapter presents a description of the DSRV sea trial behavior 
in 1 through 6 degrees of freedom using a simulated ramp input to the 
DSRV propellor. <A description of the MAIN program for generating this 
data and for identifying Meectedwvehicle parameters fron it using 
model reference contouring is also presented, The next chapter shows 
the identification results from using the model reference contouring 
technique on multiple degree of freedom sea trials and mathematical 
models, 

Clel DSRV SEA TRIALS IN 1 THROUGH 6 DEGREES OF FREEDOM 

The flexibility of the main program to be described in Chapters 
C1.2 and Cl.3 allows the running of DSRV sea trials using models with 
1, 2, 3, 4, 5, or 6 degrees of freedom using the same input function. 
This offers a useful set of results in that the vehicle coupling and 
decoupling may be observed. For example, if the surge velocity is the 


same for a 1 degree of freedom (DOF) model as it is for a 6 DOF model, 


eee 





then the identifiability characteristics of the directly related 
parameters in surge for 1 DOF should be applicable to the same param- 
eters in 6 DOF for the same maneuver, 

The input function to be used in these runs is a simulated ramp 
function to the DSRV propellor. This input function is plotted as 
curve #1 in Figure Cl.1, and the propellor angular acceleration is 
shown by curve #2 in Figure Cl.1l. This input will remain the same 
mor all of the sea trials described in this chapter. 

Using the input in Figure Cl.1 and the MAIN program (primarily 
subroutine SEATR) of Appendices Al19 and A17, the DSRV sea trials for 
46 seconds, without any control systems or tanks inputs, were calcu- 
lated using 1, 2, 3, 4, 5, and 6 degree of freedom models. For each 
of these models the respective DSRV velocities and angles were plotted: 
these sea trials will be described here in ascending degree of freedon 
(DOF) order. | 
1 DOF SURGE (u) 

The response of the DSRV mathematical model to the simulated 
ramp input when the vehicle velocities v, w, p, q, and r are not 
included is shown in Figure Cl.2. As can be seen from this figure, 
the DSRV accelerates from 0.2 ft/sec to 1.3 ft/sec during the 46 
Second sea trial. Figure Cl.2 also represents the DSRV surge behavior 
for all of the multiple degree of freedom models to be described in 
this chapter. The shapes of all of the surge curves are almost identi~ 
cal, and therefore, only the 1 DOF ~ Figure Cl1.2 and the 6 DOF - 


Figure Cl1.13 surge velocity curves are included in this chapter. 
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2 DOF SURGE, ROLL (u,_p) 

fhe roij. response of the DSHV when a 2 DOF model is vsed and 
when the roll anguler velocity is integrated at each time step to give 
tne roll angle used in the gravity forces calcuwlstions is shown in 
Pigure Cl.3. ‘The actual DSRV roli angle % (radians) throughout the 
Sea trial is shown in Figure Cl.4. The surge velocity in 2 DOF is 
almost identical to Figure Cl.2, 

Figures C1.5 and Cl.4 show that for this input the DSRV is almost 
Unstable in its roll response to this sea trial input; the vehicle 
fas a roll rate period of about 10 seconds, a maximum roll rate of 0,5 
rad/sec, and reaches a maximum roll of 0.79 radians. The fact that 
Beewsinusoidal roll velocity amplitude in Figure Cl.3 is increasing 
at a decreasing exponential rate means that even for the simulated 
Yamp input of Figure Cl.1 the roll rate would eventually become 
Cither a constant-amp)litude or a decreasing~-amplitude sinusoidal func- 
mueiOr a longer sea trial, Of course in the real DSRV the mercury 
fist tanks and their associated control systems keep this kind of 
oscillation in roll to a minimum: but for the identification studies 
of this thesis, this kind of behavior is completely acceptable and, 
mapiact, desirable. 

Meerner important fact which is indicated by the behavior of 
Bieesurfe and roll for this input is that the DSRV roll is not coupled 
anto surge. This means that for the 2 DOF model, the surge and roll 
Parameters may be identified separately. 

3 DOF SURGE, HEAVE, PITCH (u, vw, q) 

Tne vertical plane behavior of the DSRV for a simulated ramp 

input is shown by Figures C1.2, C1.5, and Cl.6 for the vehicle surge 
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(u), heave (uw), and pitch (q) velocities respectively and by 

Figure Cl.7 for the vehicle angles (¥, 0,¥). ‘The initial values 

for u, W, q were set at 0.2 ft/sec, and 0,005 rad/sec respectively. 
These curves show that while surging forward in these 3 DOF, the 
heave and pitch behavior are determined primarily by their initial 
values and have very small amplitudes of change. This indicates 
that, for this maneuver, surge is not strongly coupled into either 
heave or pitch. The fact that Figure Cl.2 still represents the surge 
behavior in 3 DOF indicates that neither heave nor pitch (at least at 
ese small amplitudes) are strongly coupled into surge. The maximum 
pitch angle throughout the maneuver is seen in Figure (1.7 to be 


about 2 degrees. 
4 DOF SURGE, HEAVE, ROLL, PITCH (u, w, Dd, q) 

The vertical plane plus roll behavior of the DSRV for a simulated 
Tamp input to the propellor is shown by Figures Cl.2, C1.8, Cl. 3, ama 
c1.6 for surge (u), heave (w), roll (p), and heave (q) respectively. 
The corresponding vehicle angles throughout the sea trial are shown 
in Figure C1.9. The most significant fact indicated by these 4 DOF 
Seeves 1S that roll is strongly coupled into heave, but not into surge 
Or pitch. Over this sea trial, the vehicle heaves downward up to a 
maximum of 0,39 ft/sec with some of the roll oscillations coupled 
into it, as seen in Figure C1.8. 

DOF SURGE, H@AVS, ROLL PITCH, YAW (u, ¥, p, a, ©) 

The vertical plane plus roll and yaw behavior of the DSRV is 

shown by Figures Cl1.Z, C1.8, Cl.3, C1.10, and C1.11 for the vehicle 


Surge (u), heave (w), roll (p), pitch (q), and yaw (r) respectively 
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and by Figure Cl.12 for the vehicle angles (7, 0,¥%). These figures 
show that surge 1S primarily unaffected by the other degrees of freedom 
for this maneuver, that roJj.. is coupled into yaw which is in turn 
coupled into pitch, and that heave is essentially unaffected by yaw. 

6 DOF SURGH, SWAY, HEAVE, ROLL, PEICH, YAW (uy, vy, w, p, gq, 4X) 

The complete DSRV response to the propellor input of Figure Cl.l 
is shown in Figures C1-.13 through (1.19. Tnese curves show that the 
vehicle is surging forward, swaying to starboard, heaving downward, 
rolling violently from side to side (+ 45 degrees), pitching very 
slightly bow upward, and yawing slightly to starboard (3 degrees) 

(see Figure T2.1 for nomericlature). These velocity plots show, in 
addition to the results for lesser degrees of freedom, that roll is 
strongly coupled into sway. For this maneuver, the most critical 
degree of freedom from a control standpoint is roll since the greatest 
motion amplitudes and rates are there. Both the surge and roll 
dynamics seem to be nearly independent of the other four degrees of 
freedom, but this is probably because the respective amplitudes of 

the other four degrees of freedom are small for this maneuver. 

There are a large number of other combinations of maneuvers and 
degrees of freedom which could be used here to learn about the behavior 
end coupling characteristics of the DSRV, The six cases have been 
presented above to show how this kind of information may be acquired 
Using the structure-selective mathematical model developed for the 
DSRV and the progyvram MAIN explained in this chapter. 

Cl.2 MAIN 6 * 6 IDENTIFICATION PROGRAM DESCRIPTION 

The program MAIN presented in Appendix Al9 represents an extrenely 

sophisticated version of the model reference contouring program in 
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Figure C1.13 DSRV SURGE VELOCITY FOR 
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Figure C1.19 DSRV ANGLES 
FOR 6 DOF (RADIANS) 
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Appendix Al2. Program MAIN is designed to run subroutine OVMOD of 
Section 5(D) through a sea trial (block), with or without v and w 
noises, in any combination of six DOF and with any combination of 
vehicle effectors. Model reference identification passes over the 
sea trial, while varying any two of the 839 DSRV coefficients and 
parameters, may then be made with the cost function values being 
calculated and contoured for each pass. A brief description of MAIN 
and some of its input data formats will be presented here, A sample 
input data deck for running the DSRV in 1 through 6 DOF blocks ané& 
identifying several selected coefficients in each block is given in 
Appendix A20. 

Program MAIN begins with a list of declaration statements which 
include some variables (such as HH) which are not used for model 
reference contouring but which would be required for an extended 
Kalman filter to be included in MAIN. Next, the roca Seeee in 
the initial data, sets variables to zero, and writes out the initial 
data for reference. Then preparations are made for running the block 
sea trial by initializing selected variables and reading in changes 
to selected variables for that block. Next, a complete description 
Of the sea trial block is written out; one small portion of this 
description is shown in Figure C1.20, where the 6 DOF model is to be 
run with secondary drag, prop, shroud, and no-noise effectors and 
with coefficient cn to be identified, Most of the block description 
Mewrrtten out in formats which are specific to the DSRV effectors. 

The next major step in MAIN is the running and plotting of a sea 


trial using subroutines SEATR (Chapter C3, Appendix A17) and sour. 
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Figure C1.20 SAMPLE PORTION OF BLOCK D&SCRIPTION FROM PROGRAM 
MAIN 








The sea trial cata may now be used in identification passes by model 
reference contouring or vy extended Kalman filtering, Mic exvenee 
Kalman filtering section of MAIN was not completed prior to the writing 
of this thesis, but several applicable subroutines are included in 
Appendix Al18, 

ihe model reference contouring steps begin by reading in the 
indexes of the coefficients or parameters to be varied and contoured 
aione With the weighting matrix for the cost function calculation. 
After writing out the characteristics of the coefficients or param- 
eters being varied, a mathematical model sea trial is run using the 
inputs previously generated by subroutine SEATR and using subroutine 
MOREY (Appendix Al7, Chapter C3). The trajectories generated by the 
"vehicle" in subroutine SEATR and the “model" in MOREF are then used 
Boecasculate the weighted integral square cost function, Finally, 
the values of the cost function are contoured and, if desired, vertical 
or horizontal slices of the contourxs are plotted, In addition, the 
logarithm of the cost function is calculated, contoured, and sliced if 
Mt (>) is set tol. 
Cl,3 DESCRIPTION OF THE INPUT DATA FOR MAIN 

This description goes card by card through the sample input data 
deck of Appendix Al9 showing the formats used and describing the 
important variables for each card. 


Card #1 Format (2074) 





KS - Number of primary states 
KME - Number of effector designators 


KAV ~ Number of second degree coefficients 
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KMV 
KMP 
KPF 
KX 
KPG 
KU 
NHMAX 
NIND 
NIN 
NST 
NOUT 
NBLT 
KNP 


NMRT 


Number of effector group designators 


Location of 1lsv parameter in P 


Number of the first parameter Broup index in HE 
Number of parameter group designators in ME 
Number of parameters in the final parameter group 
Total number of states 

Number of elements in PG used in OVMOD 

Number of input variables in U 

Number of input samples; 18 * 7 

Number of integer changes per card 

Number or variable changes per card 

Number of step function designators for UINPT 
Number of output designators 

Number of letters in word BLOCK 

Number of parameters P 


Number of letters in word PASS 


Card #2 Format (2074) 


MREF 
KFIL 
IONE 
NCN 
NCD 
NMR 

- TABO 
ITHRE 


KUA 


Model reference designator 

Kalman filter designator 

Initiativ set to l 

Number of values of lst parameter to be contoured 
Number of values of 2nd parameter to be contoured 
Numver of data points in model reference calculations 
ineepaliy 1 

Initially 3 


Location ot angles in inpuct U 


Pg 5 = 





Card #3 Format (415, 2E10.2) 
MmerAt - Initially 15 


ISEVT - Initially 16 


KEE - Dimension of EH; for Kalman filtering 
KEE ~ Dimension of E and F; for Kalman filtering 
BPS ~ Program zero plus; 07 


EMAX - Program maximum for the states 
Card #4 Format (2014) 
NGPI - Number of elements in MGP(J), NGP(J) 
MGP(J) ~- Locations of parameters to be described in groups 


Card #5 Format (2014) 


NGP(J) - Number of parameters in each group to be described 
mi bice. Output 


Card #6 Format (4012) 

M(J) = Initial designators for the structure selector 
Card #7 Format (2074) 

ME(J) - Effector designators; Chapter D2 
Cards #8 - 1) and 12 - 15 Format (4012) 

AV(J), XF(J) - Chapter D2; Appendix A2 
Card #16 Format (4012 

NE(J) - Chapter D2 
Cards #17 - 80 Format (1OF8.2 

P(J) - Vehicle parameter vector; in groups; Appendix Al 
Cards #81 - 106 Format (10F8.2) 

X(J)  - Vehicle state vector; Appendix Al 
Card #107 Format (10F8.2) 

PG(J) - Vehicle gravity vector; Chapter D2 
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Cards #108 - 109 Format (10F8.2) 
US(J) ~ Initial values of the vehicle inputs 


Gards #110 - 135 Format (LOFS,2) 


XINC(J) ~ Model reference increments of the state variables; 
Appendix Al 


Cards #136 - 194 Format (10F8.2) 


PINC(J) - Model reference increments of the vehicle 
parameters; Appendix Al 


Cards #195 - 246 Format 5(15,F11.4) 


m xS(J) ~- Starting model reference state variables; 
Appendix Al 


Cards #247 - 364 Format 5(15,F11.4) 


J,PS(J) - Starting model reference parameters; Appendix Al 


Card #365 Format (2014) 


NB - Number of blocks to be processed in this computer run 


Card #366 Format (80/1) 


Brock = Test word to make sure that the above data has been 
read in properly 


At this point the actual BLOCK and PASS data is included for the 
sea trials and model reference passes over the sea trial. data, Each 
block may have multiple passes, but no pass may apply to more than one 
Dlock. Only the cards for the first block and for the first pass will 
be described in detail here. The format for the other blocks and 
Pesses is the same, The blocks and passes in Appendix A20 are those 
used to generate the 1 through 6 degree of freedom sea trials of this 
chapter and many of the identification passes described in the next 
Chapter. The MAIN program; its subroutines, and the input cards of 


Appendix A20 required 1 hour of IBM 360/65 computation time with 
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Fortran G (Fortran H won't compile MAIN due to its size.) and gener-~ 
atea 30 thousenc lines of output descriptions, plots, and contours, 
Card #367 Format (2014) 

NBLOK - Block designation number 

NPB E Number of model reference passes in the block 

The remainder are initializing integers; 0 = initialize that vector 

Card #368 Format 10 (34,14) 

K,M(K) ‘ Card form for reading changes to the structure-selector 
vector M(6); this form is used in many cf the following 
vectors and reads changes by index directly into the 
vector until a 0 index is found either within the format 
or on a following blank card, | 

Card #369 Format 10(14, 14) 


K,ME(K) -Changes to the effector selection vector 


Card #370 Format G@OESF2) 


TZ ~ Time zero for this block 
DT - Time increment for this block 

Card #371 Format (2014) | 
NDT - Number of time increments in the sea trial 
KF - Number of coefficients to be identified 
KP - Number of parameters to be identificd 


Card #372 Format 10(1T4,14) 
| K,LF(K)- Changes to the coefficient identification vector 
Card #373 Format 10(74, 74) 
K,LP(K}- Changes to the parameter identification vector 
Card #374 Format 5(15,Fll.4) 


K, X(K) - Changes to the starting state vector for the sea trial 
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Card #375 Format 5(15,Fl1l.4) 


K,P(K) - Changes to the starting parameter vector for the cea 
tasiadk 


Card #376 Format 5(15,Fil-4) 


K,Q(K) - Changes to the w noise generation vector 


Card #377 Format 5(15,F11.4) 


K,R(K) ~ Changes to the v noise generation vector 
Card #378 Format 5(15,F11.4) 


K,U(K) - Changes to the initial input vector 


Cards #379 - 381 Format 5(15, Fl1.4) 


K,TST(K) - Changes to the input step function starting times 
vector 


Cards #382 - 384 Format 5(15,Fl1.4) 


K,UST(K) - Changes to the input step function amplitudes vector 


Card #385 Format 5(15,F1).4t) 


K,XH(K)- Changes to the starting state vector for model reference 
contouring or for extended Kalman filtering 


Card #386 Format 5(15,F11.4) 


K,FH(K)- Changes to the starting parameter vector 


Card #387 Format 5(15,Fl11.4) 


K,EH(K)- Changes to the starting error covariance matrix 


Card #338 Format 5(15,F11./}) 


K,QN(K)- Changes to the extended Kalman filter Q matrix 


Card #389 Format 5(15,Fll.4) 


K,RN(K)- Changes to the extended Kalman filter R matrix, or 
to the model reference wéignting matrix 
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Card #390 Format 10(T4, 14) 
K, 1OUT(K) ~ Changes to tne output designation vector 
TOUT(1) - Logarithmic contours 
IOUT(2) - Input function plots 


TOUT(3) - Contour slices plotted 


TOUT(4) ~ Vehicle angles plotted 


TOUT(5) 


Cara #391 Format (80A1) 
BLOCK - Test card at the end of each set of block data. 


Poa gee, rH, EH data Listed 


Wigeepass data for this block is inserted here, The first 
pass in each block of Appendix A20 is set up to contour or 
identify the coefficient X,,, and the adnaueter Kee 

Card #392 fernat (2074) 
KF - Number of coefficients to be identified in this pass 
KP - Number of parameters to be idewtified in this pass 


Card #393 Format 10(14,14) 


K,LF(K)~ Indexes of the coefficients (part of the state vector X) 
to be identified in this pass 


Card #394 Format 10(T4,T4) 

K,LP(K)- Indexes of the parameters to be identified in this pass 
Card #395 Format 5(15,F11.4) 

K,RN(K)~ Weighting matrix changes for this model reference pass 
Card #396 Format (80A1l) 

PASS - Test card at the end of cach set of pass data 

This chapter has presented plots and discussions of the dynamic 
behavior of the DSRV for a simulated ramp input in ] through 6 degree 
of freedom models. Then the MAIN program for generating these sea ~ 


trials and for identifying selected venicle parameters using model 
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> contouring was described briefly with regard to its progran-~ 


rn 


1 described fin detail with regacd to its input data cards, ne 
hapter discusses the identification results from using the model 
contouring technioque on multiple degree of freedom sea trials 


ematical models. 





CHAPTER CZ 


























JEL REFERENCE CONTOURS FOR SELECTED DSRV_ 6 * 6 PARAMETERS 

fais Chapter is the culmination of the practical results of 

is thesis, and it shows that the technique of model reference con~ 
wring works extremely well for identifying DSRV parameters in models 
jtaining as many as six degrees of freedom, The model reference 
mtouring technique used nere has been described in detail in 

apters N2 and P3, and the structure~selective DSRV mathematical 

del has been presented in Section 5(D). The MAIN program and its 
mur data cards have been discussed in Chapter Cl. 

The coefficient and parameter studies to be described in this 
hapter represent only a small part of the useful results for the 

RV which could be obtained using program MAIN and subroutine OVMOD. 
large portion of the effort in this thesis development was devoted 
tO the writing and debugging of these programs, and the studies made 
ere were done so primarily for the purpose of showing that the method 
and the programs are valid for the DSRV, ‘The results of these studies 
meepresented in the remainder of this chapter by discussing the paran- 
eters one after another starting with those identified in the 1 through 
MeOr sea trials of Chapter Cl.l. 

Bir and P(229) 

DSRV coefficient Le (-16.7) is the vehicle primary drag coeffi- 
eient and P(229) (755.) is the main propellcr thrust coefficient. 

Both of these parameters were studied in great detail in Section 4(P) 
for different input functions and different identification methods, 


Ine eleven-by-eleven contours for the identification of X,,, and P(229) 


-332- 





Using the simulated ramp input function, ne noise, and the DSRV 6 
DOF model (responses in Chapter Cl.1) are shown in Figure (C2.l, 

Tere are fewer contour points in Figure C2,1 than there were in 
the contours of Chapter P3 because each point is more costly to gen- 
erate for 6 DOF and because it is still possible to identify the 
Parameters using fewer points if lagarithmic contours are also plotted, 
Figure C2.1 has a shape somewhat similar to that of Figure P3.13 for 
Bre Staircase function input except that the bottom of the contours in 
Figure C2.1 is much flatter, making one hard to icentify. Five vertical 
Sees Of Figure C2.1 are shown in Figure C2.2, and five horizontal 
Slices of Figure C2.1 are shown in Figure C2.3. ‘These slices show the 
Vertical “trovgn" shape of the contours in Figure C2.1 clearly, along 
with the minimum (1077) and maximum (5.9) values. 

One way to greatly accentuate the minimum values for model refer- 
ence contouring is to contour log, C(p) vs the parameter values as in 
Figure C2.4 (D-13). Five vertical slices of Figure C2,.4 are shown in 
Figure (2.5, and five horizontal slices of Figure C2,4 are shown in 
Figure C2.6. The minimum value in Figure C2.4 is seen to be exactly 
at 16.7, Yo.) s wnereas in Figure C2.i only P(229) is identifiable 
(755.)- 

Identifications were made of x, and P(229) using the 1 through 6 
DOF runs described in Chapter Cl.1. The contours and their logarithms 
were almost identical in shape for these six cases to Figures C2.1 and 
C2.4, and the minimum and maximum values corresponded very closely’ as 
seen in Table C2.1. ‘These results show conclusively that the identifi- 


ability studies of Mr and P(229) for the 1 DOF model may be directly 
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extended to apply to the 6 IOF model. Therefore, if noiseless real 


DSRV data were available for this maneuver and if the structure of 
the DSRV model were exactly the same as the real vehicle, then the 
parameters X, and P(229) identified by model reference 1 DOF con- 
touring would be the correct ones for the 6 DOF vehicle. 

The same conclusions cannot be reached when noises are introduced 
into multiple degree of frceedon nedeits and data. Only afew multipie 
DOF runs were made with noise for this thesis, ana those. anddesee 
that for these two parameters and several others the gv and Zw noises 
tend to make the parameters significantly less identifiable in multiple 
DOF models than in single DOF models due to the noise being coupled 
through the various states throughout the maneuver. More extensive 
noise studies could now be made using the programs of this thesis to 
determine how the noise is coupled into various states and parameters, 
Xy (-144) 


The next coefficient studied in detail for multiple DOF models 





Was the DSRV surge “added mass" coefficient Xie This term enters into 
the DSRV surge 1 DOF model as shown in equation C2.1.e The fact that 


Xs is only 3.3% of the vehicle mass m tends to obscure it slightly when 
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(m- Xs) v= X,, lal + P(229) njnj + P(230) nu + P(231)u? 


C2.) 
DSRV mass; 4363. slugs 
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a DSRV added mass in surge; -144, slugs 
X = Primary drag coefficient; -16.7 
P(229) = Propellor primary thrust parameter; 755, 


P(230) = Propellor cross thrust parameter; -58, 





P(231) = Propellor surge thrust reduction parameter; -3.8 
n = Propellor revolutions per second 


u = Surge velocity ft/sec 





attempts are made to identify it, especially for noisy sea trials. 

The 6 DOF contours for Xu (-16.7) and Ke (--144,) for the DSRV 
aré shown in Figure C2.7, where the minimum value is 107? and the 
Maximum value is 0.03. The 1 through 6 DOF contours are almost 
identical to Figure C2.7, with the same maximum-minimum values. The 
very flat bottom of the trough in this figure shows that 2 is not 
easily identified, and the partial linear dependence (Figure N4.4, #9) 
indicates that Xv and a“ are coupled for this maneuver and could not 
be properly identified separately. Noise studies have shown that for 
3~v and 3%w noises, Ky Can be identified to within 3% but X* cannot 
be identified to better than 50% accuracy, However, even at 1.5 times 
its true value Xe is still only 5% of m in equation C2.1. 

F(230) AND P(231) IN EQUATION C2.1 
The secondary propellor thrust parameters P(230) and P(231) in 


equation C2.1 reveal more dramatically the results of parameter coupling 
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Figure C2.7 X,,, AND Xs CONTOURS, 6 DOF, 
SIMULATED RAMP INPUT 
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(i.e. linear or functional dependence), The 44 DOF contours for these 
two parameters are presented in Figures C2.8 and C2.9, and both show 
partially linear coupiing between eh and P(230) and between Xu and 
P(231). The logarithmic contours in both of these cases permitted 
perfect identifications of both propellor parameters, but it still 


may be concluded that for this maneuver the values of X 


unretts Pee 


and P(231) identified in pairs from noisy data would probably not be 
the true values. In other words, to find these four parameters when 
the data is noisy, a scheme (such as extended Kalman filtering) which 
Varies all four parameters at once should be used. However, it is 
extremely helpful that model reference contouring provides conclusions 
of this type. Contours identical to Figures C2.8 and C2.9 were also 
generated using 1, 2, and 3 DOF models, indicating that the above infor- 
mation could have been obtained from 1 DOF studies, 
2 DOF IDENTIFICATIONS; SURGE, HEAVE, PITCH; NO NOIS® 

The DSRV parameters which were identified using the simulated 
ramp input and 3 DOF model are listed in Table C2.2. The author was 
somevhat surprised to see the amount of information in terms of paran- 
eters which could be extracted from three plots (Figures (1.2, C1.5, 
and C1.6) containing 46 points each. There are probably several more 
parameters which could have been identified using tnis same set of 
data. The real identification "power" comes from the fact that the 
structure used to generate the data is exactly (no noises) the same 
as that in the model and from the fact that the parameters were varied 
two at a time with the ones not being varied having been set to their 


"true" values for the identification pass. Another helpful factor 
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Table C2.2 DSRV PARAMETSRS IDENTIFIED USING 3 DOF; NO _NOTSR 





Location of the shroud; perfect 
identification 

Perfect identification 
Perfect ide@meification 
Perfect identification 


Perfect identification; used log 
contours with P(229) 


Perfect identification; ican, 
noise susceptible 


Perfect identification; propellor 
thrust coefficient 


Log contour identification; linear 
dependence with Oe 


Log contour identification; linear 
dependence with an 


Perfect identification 
Perfect identification 
Log contour identification 


Perfect identification; DSRV 
equilibriun weight 

Perfect identification 
Perfect identification 
Perfect identification 
Perfect identification 
Perfect identification 
Perfect identification 


Log contour identification; 
location of C.G. on DSRV 


Perfect identification 
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at without the very fast roll dynamics of other DOF models, the 
¢ integrator with a 1 second time step was able to mere accurately 
e the 3 DOF model, In any case the validity of the technique and 
the computer programs has been demonstrated for multiple degree 
freedom models. 

This chapter has presented identifications in multiple degrees 
freedom which validate the model reference contouring technique as 
eans of studying parametric identifiability for combinations of 

) parameters at a time, This essentially completes the presentation 
practical results from the studies of this thesis. The next 

pter describes several of the subroutines used in these multiple 


ree of freedom studies with either model reference contouring or 


fended Kalman filtering. 
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CHAPTER C3 


DseSCRIPLION OF SH#VERAL SUBROUTINES POR USE IN TH MAIN PROGRAM 

This chapter very briefly describes the input-output charac- 
teristics of some subroutines developed for use in the main model 
reference program (written and used in this thesis) and for use in 
an extended Kalman filtering program (uncompleted). 
C3.1 SUBROUTINES FOR MODEL REFERENCE CONTOURING 

The detailed statements for subroutines SWATR, UINPT, MOREF, 
and STOUT are presented in Appendix Al7. 
SEATR (U, P, X, XN) 

This subroutine computes the sea trial trajectories (Z, ZN) 
for an ocean vehicle OVMOD in a structure-selected combination of 
6 degrees of freedom using an Buler integrator. First the inputs 
U and the time vector T are generated by subroutine UINPT. Then the 
ocean vehicle primary state vector X and noisy primary state vector 
XN are propagated from point to point over the length of the sea 
trial using simple Huler integration. These states are tested 
after each calculation to ensure stability; if the equation becomes 
unstable, integer I is set to 0, and the sea trial is terminated. 
Subroutine SEATR also conteins internally the capability (M# (19) = 1) 
of integrating the resulting vehicle angular velocities to produce 
the true vehicle angles which are used throughout the sea trial. 
Noise may be added to the sea trial data both in SEATR (V - noise) 
and in OVMOD (W - noise). 
Meeeito, US, UZ, DT, TZ, T, U) 


Subroutine UINPT computes a time vector (T) and a set of 
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combined, ten-step-function inputs U for use in a sea trial. The 
starting time and input values are designated by TZ and UZ, and the 
ten-step-function times and amplitudes are designated by TS and US, 
The time increment is given by DT, and the values of the starting 
times TS must be greater than or equal to O for the steps to be 
included in the sea trial. 

MoRzF (I, P, X) 

This subroutine is almost identical to subroutine SEATR except 
that no noise is added to the sea trial data, only one set of 
trajectories (X) are calculated, and no input functions are computed. 
These two subroutines could be combined into a single subroutine if 
the proper selection features were included in the combined sub- 
routine. 
mour ({T, U, 2, ZN, IU, N, NP 

This subroutine is used to generate plots of noisy (ZN) and 
Noiseless (Z) sea trial trajectories, vehicle angles (U), and vehicle 
input functions (U). These plots are only generated if the corres- 
ponding states (M) and effectors (ME) were used in the original sea 
trial, Several output comments specific to the DS5RV are included in 
this subroutine. 

C3-2 SUBROUTINES FOR EXTANDZD KALMAN FILTERING 

Tne general, structure-selective, six degree of freedom extended 
Kalman filtering section of the program MAIN in Chapter Cl was not 
Completed, but the following subroutines which are required for that 
program were written by the author. These subroutines are included 
here because they are completely general and may be useful to anyone 


who is using the extended Kalman filter of Steps N3.9 through N3.16. 
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The subroutines BEHDOT, KGAIN, and UPDAT in Appendix Al18 are con- 
pletely generalized versions of subroutines PROP, EFUN, GAIN, and 
UPDAT in Appendix Al4, 

EHDOT (X, U, P, BE, XD, ED) 

Mieroutine EHDOT computes both is sei kos equations N3.15 and 
N3.14 using a general ocean vehicle model OVMOD for % = XD and its 
general state and parameter gradient OVD«éR for F, The subroutine 
then combines the compressed versions of F and # (Chapter N3) and 
the compressed w,noise covariance matrix Q (diagonal) to compute 
EB = ED for use in the propagation of the error covariance matrix 
and the state estimates by the main progran. 

KGAIN (%, KB, NF, EG 

This subroutine calculates a special form of equation N3.16 in 
Step N3.12 using the H matrix in eqnpation N3.21 and the diagonal 
Values for the R matrix, This results in the calculation of the 
general filter gain matrix EG using the error covariance matrix E 
(compressed), the number of primary states KB, the matrix R (in 
COMMON), and the total number of Bete sacy states, coefficients, and 
Parameters NF, If the matrix to be inverted in equation N3,16 is 
found to be singular, the diagonal is inverted (modified if necessary) 
and a message is written stating that this was done, 

BepAT (Z, X, EB, BCG, XH, BH, KB, NF) 

This Mibroutine computes the updated values of the states XH 
and error covariance matrix EH based upon the propagated states X, 
the propagated error covariance matrix E, the noisy measurement of 
the states Z, and the extended Kalman filter gain matrix EG. The 


equations solved by this subroutine are equations N3.17 and N3,.18 in 
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Steps N3.13 and N3.14. 

this chapter has presented brief explanations of subroutines 
SfATR, UINPT, MOREF, and STOUT for use in model reference contouring 
and of subroutines EHDOT, KGAIN, and UPDAT for use in extended 
Kalman filtering. This section has presented the one through six 
degree of freedom studies of the identifiability characteristics of 
several selected DSRV coefficients and parameters using the MAIN 
progrem of Appendix Al9 and the DATA of Appendix A20, These studies 
have shown that for the DSRV the most significant degree of freedom 
is roll and that the model reference contouring technique is valid 
for up through six degree of freedom motions of the DSRV. The next 
Section presents a brief summary of this thesis and a description 


of several areas for further study. 
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SECTION 7 








|ARY AND CONCLUSION (S) 
THESIS SUMMARY AND CONCLUSIONS 


AR@ZAS FOR FURTHER STUDY 


'NO PLEASURE IS COMPARABLE TO THE STANDING UPON TH® VANTAGEGROUND 


OF TRUTH." FRANCIS BACON (1561 ~ 1626) 


HE TECHNIQUES OF MOD&L REFSRENCE CONTOURING AND EXTENDED KALMAN 
[LTERING ARE VALID AND USEFUL FOR IDENTIFYING COEFFICIENTS AND 
ARAMETERS IN OC#@AN VEHICL@ NONLINEAR DYNAMIC MATHEMATICAL MODELS 


SING NOISY INPUT-OUTPUT DATA. 
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CHAPTER S1 


THESIS SUMMARY AND CONCLUSTONS 

The studies and results of this thesis are most applicable to the 
general area of motion control of ocean vehicles, The ability to 
mathematically simulate or predict the behavior of ocean vehicles in 
response to their effectors is usually helpful and sometimes essential 
in designing or utilizing vehicle control systems, The use of a vehicle 
mathematical model permits the running of a mathematical version of the 
vehicle in a computer rather than running the real vehicle in water, 

A mathematical model for simulating the motion of an ocean vehicle 
consists of a set of differential equations, called the structure, and 
a set of undetermined variables, called parameters, The equation 
structure is usually developed by theoretical and experimental investi- 
gations vsing some of the basic principles of physics, mathematics, and 
ocean engineering. The parameters in the mathematical model are usually 
determined by observing the behavior of the vehicle, a physical model 
of the vehicle, or a mathematical model of the vehicle. The central 
purpose of this thesis is the development, presentation, DSRV utiliza- 
tion and analysis of techniques for the identification of parameters 
in an ocean vehicle dynamic mathematical model using noisy input-output 
data. The primary conclusion here is that the techniques of model 
reference contouring and extended Kalman filtering are valid and useful 
for accomplishing this identification in as many as six degrees of 
freedom, 

Model reference contovring is essentially a comparison technique 
to determine a "best" set of parameters for the mathematical mocel 
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which causes it to behave similar to the vehicle, &As a general proce- 
dure, model reference identification runs the model, with the same 
inputs as to the system, for a large number of different parameters; 
and then it selects the specific set of parameters which result in 

the model output which is "closest" to the vehicle output, 

Extended Kalman filtering is a data processing technique which 
uses known characteristics of the noise in the vehicle data to estimate 
the true (noiseless) behavior of the vehicle and its parameters through- 
out a maneuver, Kalman filtering is a linear technioue with a firm 
theoretical foundation which, when extended to nonlinear Systems such 
as ocean vehicles, loses its theoretical foundation but sometimes 
works extremely well. 

Both of these identification techniques require mathematical 
models which are in “state space" form. This means that in order to 
use these techniques, the usual] structure adopted for ocean vehicle 
dynamics must be converted to state space forme For these equations 
me State space format is simply a redefinition of the primary 
explicit variables as a set of ordered and indexed variables, but this 
redefinition process greatly facilitates both the computation of the 
equations and the inclusion of such aspects of ocean vehicle behavior 
as fluidic memory states and higher order derivatives of the primary 
states, 

The studies of this thesis begin with the development of general 
State space models for the dynamic motions of ocean vehicles, Then the 
detailed equations for the two identification techniques are presented 


and their use is described in detail. Next, the vehicle equations and 








the identification technique equations are combined for in-depth studies 
of the DSRV single degree of freedom mathematical models, Then the con- 
plete 6 degree of freedom DSRV model, its gradient, and all of its 
computer programs are described and several selected coefficients and 
parameters are identified using 1, 2, 3, 4, 5, and 6 degree of freedom 
simulated sea trials, and the results are discussed and compared, 
Finally, all of the computer programs used are listed, and a bibliogra- 
phy of references from the areas of system identification and ocean 
vehicle dynamics is included, 

several significant conclusions may be drawn from the single and 
multiple degree of freedom DSRV studies of this thesis. First of all, 
both model reference contouring and extended Kalman filtering are 
valid for the single degree of freedom models of the DSRV. For model 
reference contouring the best input function is found to be a sinusoidal] 
function with a period near the "natural frequency” or “break point 
frequency" of the system; and detailed noise studies show that for the 
DSRV surge equation, 10% process and 10% measurement noises permit 
about 10% identification accuracy of the parameters, In addition, the 
Shapes of the model reference contours show the identifiability char- 
acteristics of the parameters in addition to actually permitting their 
identification. 

Regarding the extended Kalman filtering technique, it has been 
found that it is much more difficult to "tune" the filter and that 
the integration technique must be more accurate than for model refer- 
ence contouring. However, once the filter is adjusted and given 


reasonably good initial estimates of the parameters, it is a far more 
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accurate identification technique in the presence of large (20% or 
greater) amounts of noise than is the model reference contouring tech- 
nique. In addition, the extended Kalman filter in its general fori 

may be used for the identification of many parameters at once, whereas 
the model reference contouring technique looks at the parameters two 

at a time. The multiple degree of freedom (DOF) extended Kalman 

filter presented in the computer programs of this thesis is incomplete, 
Seeetne | DOF filter is shown to be valid for the six individual single 
degree of freedom DSRV equations, 

Finally, and most significantly, the model reference contouring 
technique is shown to be valid for selected parameters in 1 through 6 
depree of freedom DSRV mathematical models. In several cases, it is 
shown that 1 DOF parameter identifiability studies may be directly 


applied to those same parameters in'6 DOF for the same maneuver, 
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CHAPTER S2 


ARBAS FOR FURTHER STUDY 

The fact that the parametric identification techniques of model 
reference contouring and extended Kalman filtering are valid and 
useful techniques for the evaluation of ocean vehicle model parameters 
opens up many possible areas for further study. These areas are 
described here in somewhat of a simplified “idea" format with refer- 
ences to the applicable sections of this thesis and to entries in the 
Bibliography in Chapter Bl. 
52-1 Develop and analyze general and specific measurement functions 
for ocean vehicles (Chapter M3.1). Study the parameters for their 
identifiability characteristics, especially in combination with the 
vehicle parameters, and perform measurement parameter identifica~ 
tions from noisy sea trial data using the model reference or EKF 
techniques. 
52.2 Develop the general state space equations of motion for a vehicle 
with a time varying mass or with an accelerating center of gravity 
(Chapter M1.2). How do the identifiability characteristics of the 
parameters change? 
b2e3 There exists a wealth of data reduction techniques for finding 
parameters in ocean vehicle models, techniques which have been used 
for many years in the field of Naval Architecture and Marine Engineer- 
ing. A comparison should be made of these techniques with the tech- 
niques of Modern Control Theory to determine the advantages and 
limitations of each. (Chapter N1.1) 
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S2.4 Instead of using a Taylor series expansion of the hydrodynamic 
forces and moments in Chapter M2.3, use a Fourier, Bessel, Hermite, 

or other type of expansion for the specification of this structure, 
Then make studies of the coefficient identifiability and determine 

the kinds of ocean vehicles best modeled by such expansions and the 
reasons whye 

Pe.) Develop the equations and study the coefficients required for 
some implicit solutions to equation M2.24, What parameters are 
required, how identifiable are they, and how much better is the math- 
ematical model with them included? 

$2.6 Relate the general theory of coefficient expansions of state 
Space ocean vehicle mathematical models to the general theory of 
covariant and contravariant tensors (Chapter M2.44). Develop general 
relationships for the numbers of n'th degree coefficients with and 
Without symmetry. Develop general expressions for efficiently and 
rapidly addressing and storing n‘'th degree coefficients in computer 
programs (Equation Dl.16 for example). 

02.-/ Develop the equations for and study the identifiability of the 
parameters in "fluidic memory" mathematical models for specific ocean 
Vehicles (Chapter M3.2). Formulate simple examples to show the 

memory effects, and use single or double degree of freedom models 

to identify fluidic memory coefficients, Formulate general conditions 
and vehicle constraints which may be used to reduce the nunbers of 
fluidic memory coefficients, Set up and evaluate multiple degree of 
freedom fluidic memory models for specific ocean vehicles. The author 
Considers the incorporation of fluidic memory states and their associ- 


ated parameters and the incorporation of higher order derivative states 





and their associated parameters to be the two most potentially 
profitable areas for further studies using the techniques of this 
thesis. 

$2.8 Study the feasibility, expense, and accuracy of using analog 
or hybrid computation and continuous parametric identification 
techniques for ocean vehicle mathematical models, This may or may 
not require decoupled models or a structure-selcective multiple 
degree of freedom model, 

$2.9 Can a list be made of most of the significant types of struc- 
ture (such as absolute square in Chapter M3,3) for a class of ocean 
vehicles (for example, surface ships)? If this is possible, then 
perhaps the identifiability meiteceristics of the parameters in 
each of these structural types may be determined separately using 
simple single degree of freedom models and combined in some manner 
to reveal the identifiability characteristics of more sophisticated 
models which involve combinations of these significant types of 
Seructure, 

52.10 Investigate model reference contouring using different config~ 
urations from that of Figure N2.1 (sce Astrom) (A-23). 

S2.11 There are some techniques in Modern Contro]. Theory which are 
applicable to specific problems of parametric identification in 
distributed systems or partial differential equations. Investigate 
general partial differential equation ocean vehicle models, perhaps 
including continuous fluidic memory, and determine techniques 
applicable to identifying parameters and to determining their ident- 


ifiability characteristics. 





ee.l2 One possible reduction of the general state-space models of 
Section 2(M) which contains linear plus second degree coefficients 
is given by equation S2.1. This equation may or may not behave like 
a specific ocean vehicle, but its nonlinear charactoristics may 
relate to those of the general models (especially the second degree 
coefficients in A>) for certain maneuvers, Study this equation in 


general using the results and techniques of Modern Control Theory. 


ReA x+ Axx 


aa 5uub+rtOxue S2.1 


j= 
bd 


zy 


Where; x = state vector 


Ww control vector 


if 


a, 6b, ¢ = known weighting or non-dimensional -~ 
izing vectors 


Ay: Ans By Bos C = system matrices containing 
parameters which must be 
identified 

Can a general state transition matrix be found for this equation? 
What are the conditions on the equation for there to be stability, 
Meservability, controllability, identifiability, invertability, etc.? 
How does the behavior of this equation correspond to known ocean 
vehicle behavior? What is indicated by the fact that equation 52.1] 
Contains no absolute square law behavior? 

52.13 The effects of vehicle control systems have not been included 
in the models of Section 2(M) (for example, equation M2,32) or in 
the programming of Section 5(D). Investigate the effects on para- 
metric identifiability for specific ocean vehicles when the control 
is a linear function of the state given by equation S2.2 or a non-_ 


Jinear one given by equation S2,3. 
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= -K x contro] gain matrix D202 


= -k (x); k 
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control function structure Se 


s2.14 It is possible to include higher order derivatives of the 
states in the general mathematical models of Section 2(M). With 
these multiple derivatives (md), included in the hydrodynamic 


Structure, equation M2.24 becomes equation S2.l, Now, if a new state 


A x - X ¢ 66 Cec (5) 


n 
“nyd (x, eee ef ey OX ) == £ (x) + X S2 eH 


—eff 


vector x Xd is defined as in equation $2.5 to include the multiple 


x mS 
Xa =| % Ea |X S205 
} i 
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derivative terms, then equation S2.4 may be written in terms of the 


multiple derivative state vector Xq 2S in equation S2.6.- The forms 


And ~na ~ Xnd ,hyd (Xn 1X4) ~ a {&& x 4) + xd ,eff (xg Da p) 


Sere 


for the matrix A_, and the vector f_, are given in equations S2.7 


ma =—md 
and $2.8, 
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A 0 
er} 
O | 0 
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Equation S2.6 is somewhat misleading in that it does not 


92.9 


directly display the n-th order differential equation behavior in 
the original equation 82.4. One way of directly showing this 
behavior is to assume that a in equation S2.4 can be solved for 
the highest state vector derivative by the function x, as in equa- 


tion 82.9. In this case, the general mathematical model could be 


written as the first order vector differential equation $2.10. ‘The 
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Where: I = Identity Matrix 92.10 





multiple derivative state vector xd usec here can also ve redefined 
a 


to include the fluidic memory states of Cnapter M3.2 and their 

multiple derivates, with the appropriate modifications to Xe 
Can a set of criteria be developed which will tell when the 

Mathematical model for an ocean vehicle should include fluidic memory 


States or multiple derivative states? (See also Chapter S2.7) It 


is expected that, as in the case of fluidic memory, the multiple 
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derivatives need not apply for many derivatives or for more than a 
few degrees of freedom. Therefore, simple models may be developed 
which include the basic effects of multiple derivatives and which 
contain nultiple derivative coefficients and parameters which may 

be identified using the techniques of this thesis. 

B2.15 The gravity forces presented and discussed in Chapter 1.3 
were included in the general category of effector forces, These 
epravity forces are functions of the vehicle orientation angles 

(y, a,7) which are in turn functions (integrals) of the primary 
vehicle velocities (states). In the later state space models of 
Chapter M2 these angles do not appear directly (They do appear 
Baxectly in the model of Section 5(D) and in the computer — 
but rather appear implicitly as an effector in Loy with atsgonmn 
state variables whose input-output behavior is all that appears in 
the model. This has the effect of making a nine ee tile (uv 
wpaqr yoy) problem appear as a six state variable (u v wp q r)t 
problen, 

Formulate the state space relationships for the direct inclusion 
of the integrals of the primary velocities Jx dt in the general mathe- 
matical models of Section 2(M). Investigate the parameters required 
and their identifiability characteristics, 
$2.16 Complete the extended Kalman filtering programming for Section 
6(C). This will require a subroutine of the form of the MAIN program 
of Appendix Al4 but somewhat larger and able to manipulate the ecneral 
subroutines of Appendix Al8. These subroutines represent, respec~ 
tively, the general versions of subroutines PROP, GAIN, and UPDAT of 


Appendix Al4, An output subroutine to plot the outputs of the desired 
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states, parameters, and error covariances would also have to be 
written. The result of this programming would be an extended Kalman 
filter capable of identifying (estimating) up to 200 pate veee at 
once for a general nonlinear ocean vehicle of the form of subroutines 
OVMOD and OVDER described in Section 5(D), 

ee. Investigate the use of a time-sharing digital computation 
program with the model reference configuration to allow an operator 

at a typewriter to "visualize" the behavior in C (p) of more than 

two parameters at once. The operator could start with the initial 
values of the parameters, make variations in those directions which 
reduced C (p), and thereby "learn" the shapes of n-dimensional contours 
and the identifiability characteristics of many parameters at once. (S+5) 
$2.18 The 6 * 6 model reference contouring program of Section 6(C) is 
so flexible and general that the author's studies of the DSRV did not 
even begin to exhaust the wealth of behavioral and parametric studies 
wnich could be conducted on the DSRV model using these programs 
directly as written. Someone interested in further studying these 
aspects of the DSRV could use this "tool" very effectively and bene- 
ficially. 

52.19 By changing only the input data and the characteristics of 
OVMOD, another ocean vehicle could be included in the 6 * 6 model 
reference contouring program of Section 6(C). This vehicle could 

then have the identifiability characteristics of its parameters 
Studied in pairs as was done for the DSRV. 

52.20 For a specific and sophisticated ocean vehicle which requires 


extremely precise control, perhaps the "model within the ship" idea 
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Jhapter 13 could be applied. What predictive capabilities are 

mired for a specified precision of control? What kind of input- 

put data and what 76 conputation facility must be on-board to 

rmit the self-identification of the vehicle? What kinds of behavioral 


al 


st functions must be specified for the vehicle to complete its 


a 


ssicns? 

21 Investigate the use of the Pade approximation technique (C-14, 

103) for modeling fluidic memory in state space ocean vehicle models. 
meee One identification technique which offers potential for application 
ocean vehicle mathematical models is the "maximum likelihood estima- 
ion" technique (S-6) (R-7) (K-14) (J+-5) (1-3) (I-44) (G-6) (C-3) (A-13). 
is technique has more general applicability than either model reference 
ntouring or extended Kalman filtering and combines several]. aspects of 
th of these techniques. Investigate the use of the maximum likelihood 
echnique for simple or complex ocean vehicle models with different 
mmbinations and configurations of system noises, 

2023 Investigate the theoretical and practical considerations which 

lead to the application of single DOF identifiability results to selected 
tiple DOF models and to the application of dual parameter identifi- 
bility results to the multiple parameter models and identifiability 


studies. 
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APPENDICES (A) 


SON neni 


Al 
h2 
A3 
AY 
A5 
A6 
A? 
A8 
Ag 
A10 


All 


Al2 


AL3 


Al! 


AL5 
Al6 
AL? 
A18 
ALY 


AZO 


NUMERICAL VALUES OF DSRV PARAMETERS AND COEFFICIENTS 
DSRV COEFFICIENT FUNCTIONS AND SELECTION CONSTANTS 
SECONDARY DRAG EQUATIONS 

IBM/SSP SUBROUTINES USED IN THIS THESIS 

CONTOURING AND PLOTTING SUBROUTINES 

CHAPTER D2 SUBROUTINES (OVMOD) 

CHAPTOR D3 SUBROUTINES (EFFECTORS) 

CHAPLER D5 SUBROUTIN®S (OVDER, GRADIENT) 

CHAPTER D6 SUBROUTINES (EFFECTOR GRADIENT) 

THE MEAN OF A SQUARED GAUSSIAN RANDOM VARIABLE 


A NONLINEAR OBSERVABILITY CRITERION APPLIED TO THE DSRV SINGLE 
DEGRER OF FREEDOM EQUATION 


CHAPTER P3 MODEL REFERENCE SINGL®S DEGREE OF FREEDOM PROGRAM 
AND SUBROUTINES 


MODEL REFERENCE STUDIES OF A LINSAR SURGE EQUATION 


CHAPTER P4 EXTENDED KALMAN FILTER SINGLE DEGREE OF FRESDOM 
PROGRAM AND SUBROUTINES 


PUTTING A "WHAMMY" ON NEGATIVE BE IN EXTENDED KALMAN FILTERING 
SUBROUTINES PROP AND RKNL WITH RUNGE-KUTTA INTEGRATION 
SUBROUTINES USED IN 6 * 6 MODEL REFERENCS CONTOURING 

SUBROUTINES USED IN 6 * 6 EXTENDED KALMAN FILTERING 

MAIN 6 * 6 IDENTIFICATION PROGRAM STATEMENTS IN FORTRAN IV (MAIN) 


SAMPLE DSRV INPUT DATA DECK FOR APPENDIX ALO 


"ROUND NUMBERS ARE ALWAYS FALSE." SAMUEL JOHNSON (1709-1784) 


THIS SECTION CONTAINS THE FORTRAN IV COMPUT#R PROGRAMS DEVELOPED FOR 


AND USED THROUGHOUT THIS THESIS. IN ADDITION, SEVERAL EXTENSIONS OF 


AND DEVELOPMENTS FOR THE RESULTS OF EARLIER SECTIONS ARE INCLUDED, 
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APPHANDIX AL 


NUMERICAL VALUES OF DSRV PARAMETERS AND COMFFICIENTS 


The DSRV states and coefficients are contained in the augmented 


state vector X(258). 


X(1) + x(6) 


aa) 
X(133) - 
The DSRV 
Pil) - 


P(37) - 


P(43) 
P(44) = 


m2) - 


Ea03) - 


103 


ie? 


150 
151 


tt 


X(132) 
X(258) 


H 


Primary states 
Second=degree coefficients 


Reverse=-i;ode second-degree coefficients 


parameters are contained in the parameter vector P(587). 


Hy 


P(36) 


P(42) = 


P(71) = 


P(102) = 


P(228) = 


- 118 = 


-~149 = 


Added mass terms Xe to Ne in the order of 


Xs located at j + 6(i - 1) 
1 
Cross products of inertia I 


oe Sm 


a & 
— Located at 


[ee 


DSRV reverse mode region determination constant 
Tanks parameters; 44~50 = equilibrium loadings 
of 7 tanks, 51-57 = x-locations of 7 tanks, 
58-64 = y-locations of 7 tanks, 65-71, z~loca- 
tions of 7 tanks 

Secondary drag parameters; 72-99 = Cros C533 
Cis: C.g, i = 1, 7 in groups of 7, P(100) = Les 


P(101) = L,, P(102) = L, ~ I. 


1! 
Shroud parameters 

Lift parameters; 103-108 = ranges, 109-113 = 
lift slopes, 114-118 = lift intercepts 

Drag parameters; 119-129 = ranges, 130-139 = 
drag slopes, 140-149 = drag intercepts 


Xo, shroud location 


Sys shroud area 
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Nes - 228 


Bye) - P(265) 

P(266) = P(559) 
266 = 290 
291 ~- 315 
316 - 325 
326 = 341 
342 - 363 
364 - 385 
386 ~ 392 
392 
393 ~ 394 
395 - 428 
hag = 456 
457 ~ 472 
473 ~- 500 
501 - 531 
532 - 559 


H 


teat specific gravity of water 
EPS or 0° for SHCAL 

Overflow indicator for SHCAL 

Lift derivative parameters; 155-164 = ranges, 
165-173 = lift derivative slopes, 174-182 = 
lift derivative intercepts 

Drag derivative parameters; 183-198 = ranges, 
199-213 = drag derivative slopes, 214-228 = 
drag derivative intercepts 

Propellor peENeUes 

Thruster Parameters 

T* ranges, slopes, intercepts, (8) 

TS ranges, slopes, intercepts, (8) 

% ranges, slopes, intercepts (3) 

if ranges, slopes, intercepts (5): 

ranges, slopes, intercepts, (7) 

ranges, slopes, intercepts, 

Thruster coefficients 

Thruster EPS or 0+ 

Maximum ranges for + u/In| 


DT” ranges, slopes, intercepts, (11) 


re 


ranges, slopes, intercepts, (9) 


© 
NO > 


af 


ranges, slopes, intercepts, (5) 


im 
I> Suk 


DT” ranges, slopes, intercepts, (9) 


Di 


ae 


ranges, slopes, intercepts, (10) 


Dil ranges, slopes, intercepts, (9) 
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P(560) - P(571) = Noise means (6) and variances (6) 

P(573) = P(577) = Constant furces and noments 

P(578) - P(585) = Variable parameters, W, xc, Yo» “age, J 
ag Ype ay 

P(586) ~ P(587) = Constants; DSRV nass and acceleration of 


gravity, G 
The following pages list these states, coefficients, and paran- 
eters as used in the DSRV simulations and identifications in this 
thesis. The start values are designed to place a + 50% region eround 
the central value of the state, coefficient, or parameter, The 
increments are set for producing this + 50% region by using the 
start valve and 46 increments for a total of 47 specific values with 


the true value at location 24, 
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APPENDIX A2 


DSRV COEFFICIENT FUNCTIONS AND SELECTION CONSTANTS 

The DSRV mode}. uses 59 of the possible 126 second-degree coeffi- 
@rents. Of these 59, 33 are functions calculated by X#UNS, 24 are 
constants, some of which have regional peculiarities, and 2 are 
functions calculated by SECAL,. 

Tne functions and constants are selected in XFUNS using the 
vector (listed across page) XF. Absolute values are selected in 
XDCAL using the vector AV. The coefficient functions may be deter- 
mined by looking at the corresponding branch of the initial conditional 
GO TO statement in subroutine XFUNS based upon the vaiue of XF of the 
desired index, 
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APPENDIX A353 


SECONDARY DRAG EQUATIONS 
The secondary drag equations presented here are the state space 
form of the similar equations in Lockheed's model (B-9). 
Variables [vest Dp aq r 
Indexes (K) 1 2 3 4 5 6 
(KM) 6 5 Bae 
Region Determination 
Regionl T< Ly - Lo one > |, 


1 


Region 2 Ll, -lo ¢<T<¢h 


J. 1 


Values of T 

vV,r Te=v/-r Indexes 2, 6 

w¥, q T=u/q Indexes 3, 5 
Values of L for DSRV 

L, 2 23.40 , Lig = 46.95 , Ly = Le = 23655 
Equations (KM = 8 - K) 


Region 1 


if 
C2 


C4 Sign (x,) ie 
K = 5 ’ 6 XC Cex Xun aster | — Cox xy *km | + 


; 2 
C , Sign (x,) x 


Region 2 


2 a ° é 
K22,3 XC = Sign (Xy44) XK (C), x1 Xp + Cex) + 


Con Xx [Xm] + Sox Ak Poko 
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Ke 5,6 xC = Cyy Xe [| + Sten (x,) xy [C5 (Xp /%y)? ip 


Cod + Cay Xu >| 








Values of Forces end Monents 


K=2,6 X=YC*.Y Y= % (30) = x(2k) 
K=3,5 X=X#Z Za = x (5h) = X(48) 


Values of Parameters Coy 


There ave 28 values of these parameters 1<I1<7, k= Z, 3, 


‘ 


5, 6 in the vector P starting at P (72) = C), and running in 


2 
groups of 7 in the order of K. 
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SUBROUTINES USED IN THIS THRSIS 
OUTINE GAUSS(IX3S3AM;sV) 





ALL RANDU(IX,1Y,Y) 
Az=AtTY 
V=(A~650)7S 4AM 
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SUBROUTINE STMQ(A;B2N,KS) 
DIKMENSTON AC 1),B(1) 


FORWARD SOLUTION 


TOL=0: 0 
KS=0 

JJ=-N 

DO 65 J=1,N 
JY=J+1 
JJ=JSJItNI]1 
BIGA=0 
It=JJ-J 

DO 30 i=J,N 


SEARCH FOR MAXIMUM COEFFICIENT IM COLUMN 


IJ=1T+] 

IFT ABSI(BIGA)-ABS(ACIJ)) 2 20,30,30 
BIGA=A(IJ) 

[INAX=I1 

CONTINUE 


Meot FOR PIVOT LESS THAN TOQLERANCE (SINGULAR HMATRIX)} 


IFCABS(BIGA)--TOL) 353;35,;40 
KS=). 
RETURK 


INTERCHANGE ROWS IF NECESSARY 


Ti=Jtn=(J-2) 
IT=IMAX-J 

DU 50 K=J,N 
TI=I1L+N 

p= P+ TT 
SAVE=ACT1) 
ACIL)=A(12) 
ACT2I=SAVE 


(eevee EOUATION BY LEACING COEFFICIENT 


ACILJ=ACTLI/BIGA 
SAVE=B(IMAX) 
BCIMAX)=B( J) 

BC J)=SAVE/BIGA 


ELIMINATE NEXT VARIABLE 


Met J—-N} 55,70,55 
TQS=N(J-1) 
D9 65 Ik=JSY,N 


IXJ=IQS+1X , 
: 55 - 

















IT=J-iX 

JO 60 JX=JY;N 

IXJX=NR(IX-2 7 41X 

=IXJUX41T 
ACIMIXISHALIXIXI-LACLXIDYAC SIX) 
BCIXJ=B(IXI-C BCA FAC IX) 


BACK SOLUTION 


DJ 80 K=1;J 
Mee y=2C18)-A(ITA)4BCIC) 
—TA=I1A-N 
PeiG=IC-1 
ENO 
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SUBROUTINE MINVCAsN,D-L5M) 
DIMENSICN ACLPSZLOELI MOL; 


eect FOR LARGEST ELEMENT 


D=1-0 

NK=-N 

8}8) 8O K=1,N 
NK=NK4N 
L(K)=K 

MK =K 
KK=NK+K 
BIGA=A(KK) 
D3 20 J=K,N 
I Z=N* (J-1) 
po 20 f=K;N 
IJ=1Zil 


Met ABS(BIGA?— ABSTACIJ))} 


BIGA=AC1J) 
L(K)=1 
M(K)=J 
CINTINUE 


INTERCHANGE ROWS 


J=L(K) 

IF(J-K) 35335325 
KI=K-N 

93 30 [=1,N 
KI=KI+N 
HGLO=-A(KI) 
ef=K1- Kt J 
ACKIJ=ACJT} 


INTERCHANGE COLUMNS 


AC JI} =HOLD 
T=A(K) 

TFCi-K} 453,45, 38 
JP=N= (I-11) 

DQ 40 J=i,N 
JK=ENK+t J 

JI=JP+J 
HOLD=-A(JK) 

AC JK) =A(JT) 

AC JI} =HOLD 


CIVIDE COLUMN BY MINUS PIVJT 
CONTAINED IN BIGA)} 


IF(BIGA) 481346),46 
D=0- 0 
RETURN 


Az 


Le 2 


(VALUE OF 


PIVOT 
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MOO 


rom 


Coens OMmOom 


Oonm 


eH) 


1G9 
uC5 


1C3 


110 


mo 55 T=1,N 

mei-K} 50,55,50 
[K=A\K+] 
ACIK)=ACIK)/S(-BIGA) 
CUNTINUE 


REDUCE MATRIX 


DY 65 {[=1,N 
IK=N\K+ {I 
HOLC=ACITK} 
imo=I—N 

DO 65 J=1,N 
IJ=1JN+hN 

moti-K) 60,65,;,60 
mosh) 62,65,62 
KJ=I1J-1+K 

AC IJJ=H=HCLDVAIKIIFATIJ) 
CONTINUE 


DIVIDE ROW BY PIVOT 


K J=K—-N 

DO 75 J=i;N 
KJ=KJItN 

TFtJ—-K} 70;75,70C 
ACK JI=HAIKII/SBIGA 
PoN TINUE 


PRODUCT OF PIVOTS 
D=D7BICA 
Bereace PIVOT BY RECIPROCAL 


A(KK)=1. 0/B1IGA 
CONTINUE 


FINAL ROW AND COLUPFN INTERCHANGE 


IF (I-K) 120,120,108 
JQ=HN( K-21) 
JR=N“C I-35) 
D9 110 J=! 
JK=JQtJ 

HOLD=HACIK) 
JI=JR+4 

A( JK) =~AC JI) 
A( Ji) =HOLD 
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APPENDIX AS 


CONTOURING AND PLOTTING SUBROUTINES 


SUBROUTINE CONTUR(NO; XsY¥3Z3Neh;,NS) 


Dee chewtioe® o ateel.s = Rigued ue . a oR ee oh ads ofr 2 ie os is ¥ a . 
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SUBRCUTINE CCNTUR 


RWIPOSE 
PLOT SEVERAL CGNTOURS OF A 2 VARIABLE VERSUS TWO 
BASE VARIABLES X ANC Y IN A FORM SUITABLE FOR 
fim siS USE 


USAGE 
Beem CUNTUR (NU, XsYoZsN_yMyNS} 


DESCRIPTION OF PARAMETERS 
Rime wcuUNTOVR NUMBER OF ,sLEo 3 DIGITS 
eet oe VECTOR OF BASE VARIABLES, VERTICAL 
Y - M VECTOR OF BASE VARIABLES: HORIZONTAL 
Z - N*®¥ VECTOR CF CONTOUR VARIABLES STGRED 
IN COLUMNWISE VECTOR FCRH 
N - NUMBER OF ROWS IN Zo N MUST BE oLlEc 47 
me eOmMEER OF COLUMAS IN Zo HM MUST BE ol Ge 57 
NS - CODE FOR DATA SORTING IN ASCENDING ORDER 
- NO SORTING 
Sas tKT xX 
ee CE g 
=e s0n BUT X= AND Y 


WAY & © 


DIMENSION K(1),Y01),Z201) 
REMARKS 
{(2)- TRE CCNTCUR IS CONSTRAINED BY THE FORMATS 
ie 4? LINE BY 5ST SPACE ARRAY FOR Wii. 
USAGE 
(2'= THIS PROGRAM REPRESENTS A HIGHLY HCDIRIPES 
VerorON OF SUBROUTINE PLOT IN THE fem eg 
Setemiae iC SUBRCUTINE PWCKAGE 
fore oUBROUTINE CCNTUR HAS TwO OUTPUTS 
1 - BOX LISTING THE CONTOUR PARAMETERS 
GN ONE PAGE 
2 =~ CONTCUR PLOTTED ON THE NEXT Peet 


SUBROUTINES AND FUNCTICN SUBPRGGRAMS REQUIRED 
NONE 


AUTHOR 
WlGrAEL No HAYES ,RM> 5-332 eMIT X6GC7 
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We Aerbs ss a he she ap ke Fe ders Be te ok Be ks eee ee Re Se Nes aes ke gee Se oats el ge BF At RO ES I 
° 4 o . ry see e ~ “oe . ’ fi “ss s . ° ° e d ° 


DIMENSICN OUT (51)+YPR(6),YPT(3) 

DIMENSICN JANG(21),ZD(21) 
OMI NEGER TANG/'1!%, *2%, 83%, 84% 58S FEF, NTs TB8 sy TOS FAT 
met yhC tt Dt FE, t Ft ytGt tht gt sh, KEL, OMS 
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PemesceR OUT 
FORMAT STATEMENTS FCR THESIS USE 
FORMAT (JH1:27X, (HCONTOUR,1X,1 8) 
PORMAT(IH sE10035'*',51A1,°%") 
FORMAT(JH ,»,10X-82' y51X,43 8) 
SOFORMAT (LHI s 6X 9 3 OH ia thei a By ay aE DS Aa da At 
11 SHS Meh es oe Kay cease ) 
BOPGCRMAT(1H »5X5*8"',12Xe7HCCNTOUR,1X,;13,12H PARAMETERS, 
Pox 2% * ) 
Merri {LH 35X,°"*slOH X RANGE :,£1164;4H TO 5£1104;, 
14H DX=,;Ello4,'*") 
TOFORMATILH 911 X9 26H¥ od 0c fo cootua00%000 0 M9000%0000%20CC%?# 
L15Hs eo eto s00*0000%) 
eeeMATCLH »3XsESo 2,1 XgEIo ZelXeE9n 251 X9EIn Ze1X EGU 2 51X3 
EES? ) 
QOFURMAT(1LH 35X9"**,1L0OH Y RANGE 2761104 94H TO £1154; 
14H CY=;6€1154, '%*") 
L3ZO0FORMAT(1H ,5X,*%",1i0H Z DOMAIN: ,£11064,4H TO ,E1l104, 
14H CZ=,EIi1l04,'#") 
L7TOFORMAT (LR »5X%,%8*,27H 2 DCMAINS FOR THE CONTOURS, 
Mee sMAX VALUES FOR EACH,3X,°#") 


Ww hy = 


’ 


2ZOOFIRMATILH 95X°#*44H NOo 9 12;:F116494H NOod 12; 
1—E110454H NOs, 12;,;E1154,'s'") 
23 OFORNAT (72H : 5X2 OH or hee ok ie secgs Bee oy ee eS Ge MOK eRe O IMLERS ENE LD pg 


11 SHS SA tisg Bt eas eS) 
60 FORMAT(IH 5,18Xs" B@o000% INCREMENT IS %,£1507) 
G1 FORMAT(IH »8X,E1507:5XeEL So 73 5X9E1507) 

NL=47 

NTH=E51 

ZCON=1.99 

NCCNT=21 

NLELENL 

SORTING ROUTINES 

NSKIP=0 

IF(NS~-1)105;,161,i02 
moe IF(NS-2)105;,103,104 
C4 NSKIP=1 

SORT X 

101 DO 15 IT=1,N 
DO 14% J=I,N 
TFC X(T )-X%(J))014514,31 

Bl Pex 1} 
X(T )=X(J) 
X(J)=F 
L=I-N 
bi =J--N 
D9 12 K=1,M 
L=LtN 
LL=LL+h 
F=Z(L) 
Z{(L)=ZELL) 
Z(LLI=F 

12 CONTINUE 
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A 
13 


40 


CONTINUE 

CONTINUE 

IF(NSKIP)105;105,103 

SORT Y 

DJ 25 J=1,M 

DO 24 J=I;h 
TFIY(1)-Y(J))24 2452) 

F=Y(1) 

fol y=Y (J) 

Y(J)=F 

L=( 1-1 )2N 

LL=(J-L)EN 

DG 22 K=1,N 

L=L+] 

me=-LL+i 

F=Z(L) 

Z(LI=Z(LL) 

Z(LLI=F 

CONTINUE 

Sent TINUE 

CGNTINUE 

Beno BASE VARIABLE SCALES 
XSCAL=(X(N)-X(1))/ CFLGATC(NLL—-1)) 
YSCAL={Y(MI-Y(1)) /¢0FLOATCKTH-1)) 
SET BLANK 

BLANK=0 

FIND CCNTOUR VARIABLE SCALE 
ZMIN=150E75 

ZMAX=-1-0E£75 

Mil=] 

M2=N78 I 

DO 40 J=M1,N2 

IF(Z( JS )0GTs ZiWAX)ZHAX=Z( J} 
MeeLivdyol To ZAIN) ZMIN=AZ( J) 

CONT PNUE 

LINEAR INTERPOLATICN FOR NCONT CONTOURS 
meen —(27MAK—ZMIN)I/FLOAT (NCCAT—21) 
IF (ZSCAL»s EQ. 05 ) ZSCAL=10 OE-40 
DEVELGP AND PRINT CONTOUR PARAMETER BOX 
AMIN=X(CL) 

XMAX=X(N) 

YHIN=AY (2) 

YAAX=Y(H) 

WRITE(654) 

WRITE(6,5)A0 

WRITE (636) XMIN»XMAXsXSCAL 
WRITE(6;93} YMIN, YMAX;YSCAL 
WRITE (6,33) ZMIN,yZMAX,ZSCAL 
WRITE(6,17) 

Z0(1)=ZMINt(2-¢ O-ZCGN)*ZSCAL 
NZCAL=hCCNT-2 

Mors 1Z=1,NZCAL 
ZOCIZ41)=Z0(1)4+FLOAT( IZ) ZSCAL 
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Lo 


23 


$0 


CONTINUE 


LOC NCONT ) =ZMAX 


IP=7 

DO 19 I[Z=1:1P 

N1l=12 

N2=N1+4+IP 

N3=NZ+I0P 
WRITE(6s;20}N1-ZD(N1),N2,ZD(N2) 5N3,Z2D(N3} 
CONTINUE 

WRITE(6,23) 

MpeecoULATE THE Y SCALE VARIABLES 
YPR{1L)=Y 1) 

DO 90 Ki=1 4 
YPRIKN+LI=AYPRIKNI+YSCAL?10,0 
CONTINUE 

YPR(E)=Y CHM) 

YPT(CLI=YAIN 
YPT(2)=YMINFYSCAL*25050 
YPT(3)=YMAX 

YSTAR=YSCAL<=5,30 

PRINT FEADING 

MeL TE(6,1)N0 

WRITE(6,60)YSTAR 
WRITE(6-61)(°YPT(ITP),1P=1,3) 
WRITE(6;8) (YPRC IP) ,IP=1,6)} 
WRITE(697) 

PenO TRE X SCALE PRINT POSITION 
XB=X1) 

i=} 

T=] 

KMEPS=XSCAL/FLCAT(227(NLL—-1 )) 
YEPS=VYSCAL/FLOAT(2Z2#(NTH~1 ))} 
F=FLOUAT{I-1) 

XPR=XB+F=XSCAL 

AOL F=X(L)—XPR-XEPS 
meellF)50,50,70 

meee ThE Y SCALE PRINT POSITICN 
oi) +55 IX=1,;NTH 

OUT (IX )=BLAKK 

CONTINUE 

K=1 

LR=7 

YB=Y(1) 

G=FLOAT(K-1) 

YP=YBtAGrYSCAL 
YDIF=Y(LM)-YP-YEPS 

IFC YDIF)30;30;21 

FIND CCNTUUR POSITION AND MAGNITUCE 
JZ=(LM—-1)ENFL 
JP=IFIX(((Z(JZ)-ZMIN)/ZSCAL)4+ZCON) 
OUTCK)=LANGCJUP) 

LY=LM4+1 

K=K+1] 


293 


















IF CK-NTH1 35,34 536 

YP=Y(i4) 

Ga hC 37 

PRINT THE LINE 

5 WRITE(692)XPRs (CUT(I1Z),1Z=i,NTH) 
L=L+1 

GJ TO 80 

Bem TRE LINE 

) WRITE (6;3) 

mei= 1+) 
JFCI-NLL} 45,84, 86 

i XPR=XCN) 

GO TO 50 

PRINT BOTTOM AND Y VARIABLE SCALE 

5 WRITE( 6,7) 

WRITE (618) {YPR(IP),IP=1 45) 

RETURN 

END 
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MN OAADAADAA|AAIDAA|AOYAIDAOAAAIAIYIANOYAIAMAADAIAIAIAAADMNH 


PANO AMTAAANDIMNAADAANININAIMAAYD 


SUBROUTINE PLOT(NOsA,NgM,NS) 


Sects: Sis vk is eee so 0h aS) We ake adooPo «39 ee ee 
xe SE sh opp ah pe ek Eso? Hy PAP MC Pp RE ee eae ab dete beads ak yp bs da oh feats oats 


SUGRP@UTINE PLOT 


PURPOSE 
PLOT SEVERAL CROSS VARIABLES Y VERSUS A BASE 
VARIABLE X IN A FORMAT SUITABLE FOR THESIS USE 


USAGE 
CALL PLCV(NOsAyN3M,NS) 


PeoCnPPiiCN OF PARAHETERS 
heer eC i NUMBER OF ocLEe 3 DIGITS 
A =- MATRIX OF DATA TO Be PLOTTED, MUST BE IN 
STANDARD SINGLE CCLUMN FORM, FIRST CQLUMN 
PirReoeNtS BASE VARIABLE AND SUCCESS 
COLUMNS ARE THE CROSS VARIABLES (MAXIMUM 1S 
NINE)o BASE VARIABLE IS VERTICAL, 


Moo— NUMBER OF ROWS IN MATRIX At WN MUST BE 
olEe 4/7 

M - NUMBER OF COLUMNS IN MATRIX Ac M MUST BE 
ale 10 


NS - CODE FOR SORTING THE BASE VARIABLE DATA IN 
ASCENDING GRDER 
O SORTING 1S NOT NECESSARY(ALREADY IN 
ASCENCING ORDER) | 
1 SORTING IS NECESSARY ! 


DIMENSION OUT(51L);YPR(6),TANG(9) 5,401). YPT (3) 


REMARKS | 
(1)- THE PLOT IS CONSTRAINEC BY THE FORMATS TO 
A 47 LINE BY 51 SPACE ARRAY FOR THESIS USE 
(2)- THIS PROGRAM REPRESENTS A SIGNIFICANTLY 
MODIFIED VERSICN OF ITS NAMESAKE IN THE 
IBM 360 SCIENTIFIC SUBROUTINE PACKAGE 
(3)~- THE PLOT STARTS IN THE UPPER LEFT CORNER 


SUBROUTINES AND FUNCTICN SUBPROGRAMS REQUIRED 
NONE 


AUTHCR 
MICHAEL No HAYES »RMo 5-333sMIT X6807 


2. ° ~ . = 2. Re eit alle Re ot a de ake i oe 4 ¥: « Rp wtp ole of- # 4,,0 0,0 one? ods of, : WWD. r239 3 Ro Hel ke * He 
eat Bech: Et Bs SRR HSE LS. BA SR MY. e- Ps 322 e+ SPE ON ies SAD : SE AIBN. ay gE AL 


—e 2° 6 . s 
os 


MTEGERUIANG/ 16492, 134s 145, 15h 8 Gh ths BPs OT 
INTEGER CUT 
FORMAT STATEMENTS FCR THESIS USE 


1 FORMAT C(iHLis27X,7H PLOT 9 1E) 
2 FORMATELH 261003 ,°#',52A1L,°%*) 
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3 
4 
5 


meer 5 lOX,'3',51%.8: #) 
FORMAT(QH 18X59" ~oooo% INCREMENT IS *,EDSe 7) 
FORMAT (iH Wows) 50 135K ELS 7, SKy E1507) 


7ZOFORMATCIH sllx, SOH* owes coo*%ongd#500 oF%9 000% 000*%0000 "3 


a2 
e 


LiSHooo oVov00o0 007) 


B8O0FORKMAT (LH pomp i9o 231 XsE9, 291X2E9n 291% 69H 2,1 XE SS; 


S 


10 


11 


40 


$0 


LEP02) 


FORMAT(LH ) 
NL=47 

NTH=5} 

NLL=ENL 
IF(NS)16,16,10 
SURTING ROUTINE 
D9 15 J=1,N 

DO 14 J=1;N 
IFCACT I-A J) 314514,11 
B—{1-N 

LL=J-N 

DD 12 K=1,M 
L=L74N 

LL=LL+h 

F=A(L) 
A(LI=A(LL) 


2 AC(LL)=F 


CONTINUE 

CONTINUE 

SET BLANK 

BLANK=C 

fimo GASE AND CROSS VARIABLE SCALES 
Poor =(A(N)—-A(1))/ CF LCATOCNLL—-1)) 
ML=N+1 

YMAX=~100E75 

YMNIN=100E75 

M2=M2N 

DU 40 J=M1,N2 

IF (ACJ) c€To YMAX) YMAX=ACJ) 

IF (ACI) ol To YMIN) YMIN=ACJ) 
CUENTINUE 

YSCAL=(YHUAX-YMIN) 7500 0 
IF(YSCALo. EQ, 02 JYSCALE1, OE~40 
YPR(L)I=YMIN 

DIO 90 KN=1,4 

YPR(KN#2I=YPROKN) +YSCAL“1006 
CONTINUE 

YPR(6)=YHAX 

YPTCV)=YMIN 

YSTAR=YSCAL:75,0 

mea 2) =YMINAYSCAL¥25,0 
YPT(2)=YMAX 

PRINT KEADING AND CROSS VARIABLE SCALE 
WRITE(6512)NO 

WRITE(Es4) YSTAR 
WRITE(6,5)(YPTC IP}, IT P=1:3) 
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45 


50 


€0 


10 
&0 


E35 


WRITEC OSB) (YPR( IP): IP=1,6) 
WRITE( 6,7) 

FIND BASE VARIABLE PRINT PCSITION 
XB=A(1} 

L=i 

MY=M~-i 

|) a 

Meer o-XSCAL/FLCAT(2*(NLL-1)) 
meareLoAt(i-1) 
XPR=XBt+F*XSCAL 

Pee awt iy) —XPR-XEPS 
IF(XD1IF)50,50;7C 

FIND CROSS VARIABLES 

we 5>5 [X=]1,NTH 

OUT( IXI=BLANK 

CUNTINUE 

09 60 J=1,MY 

LL=L+J“4N 
JP=(CA(ILLI-YMIN)I/SYSCAL } 4160 
OLT(JPJ=HIANGUSJ) 

CONTINUE 

PRINT LINE ANCO CLEAR, CR SKIP 
WRITE(E622) XPR; (QUT(1IZ),12=1 »NTH; 
L=Lt+i 

GU TC 80 

WRITE( 6,3} 

T=[+] 

Bet I-NLL145;84, 86 
XPR=ACN) 

G3 TO 50 

PRIw)T BOTTGM ANDO CROSS VARIABLE SCALE 
WRITE(6,7) 
WRITE(6,8)(YPR(IP),IP=1,;6) 
WRITE(5,9) 

RefURh 

ENO 
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APPENDIX A6 





CHAPTER D2 SUBROUTINES (OYMOD 
SUBROUTINE OVHOD (HE 2AVIXE s PaINaUshEsX, Xi y XD XONaKBaL) 


of a 
C +3 PUK PPNAT a HN ae Sip ipl af agi ae ole cpane ade ky: 


C SUBROUTINE CVMOD 





SE re a Ee Se ae SY 


Bye POSE 
TG COMPUTE ANY SELECTED COMBINATION CF THE TOTAL LINEAR 
AND ANGULAR ACCELERATIONS AT A GIVEN TIME FOR A GENERAL 
OCEAN VEHICLE INCLUDING ALL CESIRED INPUTS AND,IF 
SPECIFIED,;A NUITSY ENVIRONMENT 
EQUATION- 
ADX/CT=EEC(XKIJ#X 12 XS) +X EF FECTORS+XGRAVITY+ 
XDI STURBANCES*+XCCN STANT +XSECCNDARY 
WHERE- € IS SUMMATICN FOR 6 DEGREES OF FREEDOM GR 
ANY SELECTEOQ COMBINATICN CF 6 DEGREES 


LANGUAGE :; FORTRAN IV 


SUBROUTINES REQUIRED 
TANKS sGRAVT yACALC,SHCAL » XDCAL,SIMQ,XCIST 


MeasCRIPTION 
CHAPTER O02yM2Nao HAYES THESIS sMITs1971,;NAME DEPARTMENT 


OVKAVOVOHGHO gaya err a aoa rr ae es 


eee Mee 2 Aa ee Mee hae EY Re RA Be eee a kes hoe ee wt Mp ae eee 
“INTEGER AV 4XF 
OOIMENSIGN ME( 1) sAV(L) »XF (1) PCL) INCL) SUCLISNEG1); 
UX(1)2XNC1i),xXD0(1),XCONC1),0L01) 
DIMENSION XGRAV(6),XPD(6),PG(38):XS(6),A(0SE) ANC 3E) 


C SETUP FOR TANKS AND GRAVITY CALCULATICNS 
¢ Seer PG INITIALLY FROM P 
MT=ME(L7)-1 


Oo > K1=1;8 
PG{KT )=P(MT+KT) 
3 CONTINUE 
C TEST FOR TANKS CALCULATICAS 
Bere (3 )-oNE51)GO0 TO 1 
CALL TANKS(P,ME(10),U,;NE(1);PG) 


C CALCULATE GRAVITY FORCES AND MCMENTS 
1 CALL GRAVT(ME(8),U,;NE(10),PG,XGRAV;KByL) 
C CALCULATE THE DERIVATIVE TRANSFORMATICN MATRIX ~- A 
MG=ME(16) +) 
G=P(MG) 


CALL ACALC(P;PGsGsAsKBoL) 
IKB=KB="KB 
09 1S IA=1,1KB 
AN(IA)=A( IA) 

13 CGONTINLE 


C BEGIN NOISY AND NOISELESS DERIVATIVE EVALUATIONS 
ews 1 
IF(ME(6).EQ31)GC TO 3 

C [MST FOR SHROUD CALCULATICN - NOISELESS 


meee CME 3)SNE51)GO TO ¢ ; 
OCALL SHCAL(P,ME(12) 4XsU2NEC7) »NE(2)sNE(LL) NE(L EDs 
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Tl 


Proenk oy; L ) 
CALCULATE NOISELESS FORCES ANC MCMENTS 
6 DO 7 K=1,KB 
KX=L(K) 
CALL XCCAL(ME sAVyXFyPyPGyU,NEyX sXCCSKPGL, KX) 
IF({ME(3)0oNE.1)GO TO G 
XPD (K)=XDC+XGRAV(KX)4XS(KX) 
Gy TO 7 
XPD(K)=XDC+XGRAV(KX) 
CONTINUE 
memwr AND SOLVE SINULTANEOUS EQUATICNS FOR 
MeeroELESS DERIVATIVES 
IF(KBe EQo1)GO TO 20 
CALL SIMNQ(A,;XPC,KB,KSIM) 
TEST FOR VALIC SOLUTIEN 
PPI(KSIMSEQ,.0)GO TO 8 
morwRITE(6,18) 
13 FORMAT(IX,*SIMQ IN OVHOD GIVEN SINGULAR A-MATRIX!® ) 
WRITE(6,15)(°PG{ J) -J=1,8) 
15 FORMAT(1X, *PG=',8E15.7) 
DQ 10 K=1,KB 
XO(K )=O0o0 
XCON(K) =00 
10 CONTINUE 
RETURN 
20 IF(A(1).0EQ00.)GG TO 16 
XPD(1)=XPC(1)/A(1) 
Meroe CALCULATED NOISELESS CERIVATIVES IN XD 
8 DY 1} K=1;KB8 
XO(KJ=XPO(K) 
mi CONTINUE 
GU TO 4 
MaecULATE NOISY FORCES AND MOMENTS 
Perr thE (9)o EQoL1) ISW=2 
Meon FOR SHROUD CALCULATICN + NOISY 
Meet s),NE.1)G0O TO l2 
OCALL SHCAL(P,;ME(12)sXNeUsNE(7) NEC 2), NECLILISNECI2), 
1XS:KB,L) 
MemeCULATE NOISY FORCES ANC MEMENTS 
12 DO 13 K=1,KB 
KX=L(K) 
CALL XCCAL(ME;AV,XF;PePG,U;NEgXN,XEC,KBGL XX) 
CALL XDIST(IN;PyME(15);XNO,KX; 6) 
IF(CME(3)-NE0.1)GO TO 14 
XPC(K) =XDC+XGRAV( KX) +%S (KX) 4XNO 
GO T0 13 
14 XPC(K)=XDC+XGRAV(KX)4XNC 
13 CONTINUE 
SETUP AND SOLVE SIMULTANEOUS EQUATIONS FOR 
mercy DERIVATIVES 
IF(KBoEQ-1)GO0 TO 21 
CALL SIMQ(AN,XPC,KB;KSIM) 
Mest FOR VALIO SCLUTICN 
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*e 










CRSTHSEQ21T)GO TO 16 
N€1I0EQ000)G0 TO 16 
PD(1)=XPCL1)/AN(1) 

PLACE CALCULATED NOISY DERIVATIVES IN XON 
DI 17 K=1,KB 

KON (KP=XPO(K} 

es) TO (4,32), I1SW 

RETURN 


-10- 





BSUEROUTINE ACALC(P,PG,G,A;KB,L} 
PPAR ESA RIE ER RA ay wae oiag ary aig edt dapat saga 


SU3ROUTINE ACALC 








URPOSE 

TO CALCULATE THE OCEAN VEHICLE A-MATRIX CONTAINING 
ADDED MASS AND INERTIA TERMS 

SLSROUTINES REQUIRED 


BescRIPTICN 
CHAPTER D2,MoNoHAYES THESIS, MIT,LOTL NAME CEPARTMENT 


en, Te | 


DIMENSIGN P(1),PG(1),A(1),L01) 
J=1 

VM=PG(1)/6 

DDO 28 K=1,KB 


KR=L(K) 

we 2S [=1,KB 

IM=L{1) 

N=IM462 (KM-1 ) ; 
OGD TO (192939415965 798599,10511,12513514915516 517518, 
1139:20;21;:22; 392432592652 22289295 3023153225235924 535) 
236) ,N 

Lh AC=VM-P(1) 

eo 710 3/7 

2 AC=GCo 
GJ TO 37 
3 AC=0. 
GO TO 37 
4 AC=0c 
so Tc 37 
5 AC=VM?PG(4) 
GO TO 37 
6 AC=~VM*PG(3) 
GO 70 37 
@ AC=05 
SoeTrt 37 
§ AC=VN-P(8} 
So710 37 
3 AC=0, 
Gu 10 37 
10 AC=-VMEPG(4)-P(20} 
coe 37 
11 AC=05 
ee TO 37 
2 AC=VM=:PG(2)-P(32) 
oe Te 37 
13 AC=0o. 
GQ TO 37 
14 AC=05 
ae VG 37 


Buin 





15 AC=VM-P(15} 


SorrO 27 


5 AC=VM2:PG( 3) 


mea 10 37 


17 AC=-ViNSEPG(2)-P(27) 


GG TO 37 


m3 AC=O0. 


Ga TO 37 


19 AC=0. 


oo 1C 37 


20 AC=-VM#PG(4)-P(10) 


ope TO 37 


G3 10 37 
AC=P(27)-P(22) 
Sef 10 37 

AC=0o 

Go TO 237 

AC=C>3 

Ge 10 37 
AC=VM=<=PG(4) 

GO 19 37 

AC=0o 

So tC 37 
AC=-VM¥PG(2)-P{17) 
Ge iC 37 

AC=0o 

69 1G 37 
AC=P(2S5)-P(29) 
Os 10 37 

AC=05 

G3 TQ 37 
AC=-VM#PG(3) 
GO TO 37 
AC=VM#PG(2)-P(12) 
GO TC 37 

AC=0> 

GO TO 37 

AC=05 

GO 10 37 

AC=0o 

Go TO 37 
AC=P(42)-P(36) 
A(J)=AC 

J=J+1 

CONTINUE 
CONTINUE 
RETURN 

END 


ioe 


| or 
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roan aon ee) 6s Cr Oe) es oe 


tla XDCALCHE sAVy_X By Ps PGs “# Wis | be saan Aa 
KH TRE BOSS BOY BASIE ret as See ae gs ete Soh ay Ki op eas Beastial Meo: hy & 


Rey ae a BA a oe ke 
SUBROUTINE mL CAL 


mer ISE 
foeeeroINE COEFFICIENT AND EFFECTUR FORCES WITH ANY 
memectED GROUP OF EFFECTORS ANO ANY SELECTED GRCUP OF 6 
Meemets> OF FREEDCM ,» SUBROUTINES ARE SPECIFIC TC THE 
memmeepeeONEY SECCNC DEGREE CCEFFICIENTS USED 


MeeROUTINES RECUIRED 
eoeivomoelCALsPRCAIL, THCAL ,COCAL 


meoCRIPTICHK 
mee SUBROUTINE CVMOD 
CHAPTER O2sMoNc HAYES TRESTSsMIT,1971sNAME DEPARTMENT 


le a, hs EE eR ee He a Aas phe ges pp bh aks Seti ke WHS Eh Hs POKER 
INTEGER AV yXF 
DE NSICN MEL) ,AV(1L) »XFC1),P01L),PG(1),U0L) NCL) X02) 
OieeeiolIN L()),PC(8),NTC8) 
See PARAMETERS FOR XFUNS 
MC=HME( 28) 
fe) =P CI )/PCMCt) ) 
PC(2)=PG(2) 
PC(3)=PG(3) 
PCO(4)=PC(4) 
PC{5)=Pi37) 
PC(6)=P(39) 
PC(7)=P (42) 
PC(8)=P(43) 
BEGIN PRIMARY TERM CALCULATIONS 
XD=0>5 
D9 1 I1=1,KB 
IM=L(1) 
DQ 2 J=1,KB 
CALCULATE PRIMARY TERM INDICES 
JM=L(J) 
eae! JPe(IV—-1))/24+21¢0K-2) 
KIJ=IJK+6 
meson fFor ERM TC BE SKIPPED 
TF(XF(IJK}.EQ,0)G0 TO 2 
CALL XFUNS(PCsXsKIJSsXCeXF) 
TEST FOR ABSGLUTE VALUE TERMS AND CALCULATE 
TFC AVC IJK) 18,1079 
8 XD=XD+tXC#ABS(XCIM) 2 X( JIM) 
GOTO 2 
I XD=XD4XC#XCIN)SABSOX( JIM) ) 
GQ 10 z 
10 XD=XD2XC#X(iM)*X( IM) 
2 CONTINUE 
1 CGNTINUE 
SECONDARY TERM CALCULATICNS 
~t)] 3- 


















IFCME(2)-¢ NEL )GC TO 3 
wat Seer eP EME (2 2 beX sXSs Ky XSO,¥ST) 
x =XD+XS 
PFOPELLOR CALCULATICNS 
. FF(ME(4)oNE.1)C60O TO 4 

LL PRCAL (P,ME(13)9XsUsN{E)9N(3)yXPyK) 
XD=XDO+XP 
THRLSTER CALCULATICNS 
meee ret SyONEOL GO TO 5 
NTC 1) =N(4) 
NT(2)=N(9) 
00 7 1=3;8 
NTC 1)=N( 1410) 
fee) INUE 
CALL TECAL(P,ME(14);UsNT,X,XT;,K) 
XD=XD+tXT 
CONSTANT TERMS CALCULATICNS 
meprame( 7)oNEo1)GO TO 6 
CALL GOCAL OP,ME(15);X—»XCO,K) 
KD=XD+xCO 
6 RETURN 
iD 


Oe 









meewOUTINE XFUNS(P,X,K,XC,1]) 


BASE RAE Sella S EE gS EE GS Oy Oh A ha aA ih ace eb hank sy dug p bag. 


SUBROUTINE XFUNS 


IERPOSE 





TO COMPUTE ThE FUNCTIONAL VALUES OF THE SECCND DEGREE 
SegereeeCiERTS OF THE DOSRV 


SLBROUTINES REQUIRED 






37 


neal 
41 
a2 


50 


e 
2. <n ~ og s= 98s oS, wtp weeks gore 2 whee Se of9q.0 mc ode ws ode gt 
SS FG PABA SRR MIA iy ge 


oe) fC 
157261,;62,713725 74, 79,83 592,95,97,101,103 51134,118;119, 
ree 22,12/3128,129,130); 1S 


ACNE 


DESCRIPTION 
See SUBROUTINE XCCAL 
CHAPTER D2sMoNoHAYES TRESISsMIT:21971 »NAME CEPARTMENT 


wen tet Se i J 


teog Ai Ae ai Be oy ay hI of el eh aps. Rope oe 4 
DIMENSION P(1L),x(1),101) 

ISW=I(K-6) 

INITIAL CONDITICNAL GC TO STATENENT; 
PROPER FUNCTICN 

O8Sy 515 ,17,19.21, 20,31, 35,381 41,42 9 505 Gy 5S; 


BRANCH TO 


XC=X(K)-P(1} 

RETURN 

me=P tl ¥P (3) 

RETURN 
XC=X(KI+P CL) P02) 
RETURN 

XC=X(K)+P (1) 

RETURN 
XC=X(K)-P(01)=*P(4) 
RETURN 
XC=X(K)t+P(1)P(2) 
RETURN 

XC=X(K)+P(1) 

RETURN 

me=P(1)*P(3) 

RETURN 
me=ntiwi—-P(1)%P(2) 
RETURN 

BeOx{l)letTo.0-.)GO TO isl 
XC=X(KI@SIGN(1o,X(L))-PC1) 


RETURN 
XC=X(K4126)%SIGN( Lo ,X(1))-PCL) 
RETURN 

XC=-P(1L)#P (4) 

RETURN 

XC=P (1 )-*P(3) 

RETURN 

XC=X(K)-P(1) 

RETURN 


XC=X(K)4P (1) P(4) ee 





134 
Bf 
101 


103 


ReTURN 

PPUX{T)olTe0.)GO0 TG 132 
XC=XUKISSIGNO 25 .X01))4P(1) 
RETURN 
XC=X(K*1L26)"SIGN( Lo yXCi}) +P) ) 
RETURN 

XC=P (LP (4) 


RETURN 

eee J—-P(1)*P(2) 
RETURN 

me Pt 1)-P (3) 
RETURN 

me PL) P (3) 
RETURN 
XC=X(KI-PCL)EP(4) 
RETURN 

RC=P'(1 )*P(3) 
ReoITURN 


IF(X(1l)oLTcO- )GO TO 133 
XC=X(KIFSTGN(2osX(1))4P (1 )8P(4) 
RETURN 
XC=X(K4126)¥"SIGN(15o—9X(1)) +P (1)*P(4) 
RETURN 

XC=X(K}+P0E)-P(7) 

RETURN 

XC=X(K)I4P(1L)=P (2) 

RETURN 

Merk dioltie0,)/G0 TO 134 
XC=X(KISSIGN( Lo sX(1))-P (LI P(2) 
RETURN 

me ACK4A1 26 )*SIGN( 26 5X(1))-PC1 FP CZ) 
RETURN 

XC=-P(1)#P(4) 

RETURN 

XC=X(KF+P(1)=P(4) 

RETURN 

meen KitP(7)-P(5) 

RETURN 

XC=X(K)+P(LIEP(2) 

RETURN 

XC=P(1)7P (3) 

RETURN 

Meo =metK +P (5)--P{ 6) 

RETURN 

IF(X(1L)oLToO. GO TO 135 
XC=X(KIESIGN( Lo sXC1))-PCLIEP C2) 
RETURN 


5 XC=X(K+126)*SIGN (Lo sX(2))-PCL ISP (2 


RETURN 
Bo-- Pt ty*P (3) 
RETURN 
XC=X(K) 
RETURN 


a 6- 







“tes 


« 


‘7 











Seeeteet i Fot 1502 )G0 TO 126 
C: UK ) 


mere 12 35,238,138 

TFEC(X(2}-P( 8)*¥X(1))0GT000)G0 TO 137 

x y= x { K} 

RETURN 

mere COX (29—P( 8 )X61))0LT20.)60 TO 137 
XC=H=X(K) 

ee TURN 
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SUBROUTINE SECAL(PsM,XsXSyKyXSO}XST) 


. an Se de fe Seat we Vase chs seedrateuls of. ote are sen + Leekendp ode etsciae seedy ue . <a a . ay, am oe e ‘ 
gras Bes ey: heap ce ecm ah esse es RE ak ah og bea ee pe gta ey: 


10 CALCULATE TFE SECCNDARY CRAG FORCES AND MOMENTS FUR 
TRE DSRV 





mEEROUTINES REQUIRED 
NCNE 


CESCRIPTION 
CHAPTER D2yMoNcHAYES TREESIS sMIT;19O715NAME CEPARTMENT 


ir er ce ems Theoden te ch: 8H Lh oe Sp Sk of 2g oR eRe he Shy Happ ee ae Le A eee eK 
Meee NoOlON P(1)4X (1) 
INITIAL SECCNCARY ORAG RECICN DETERMI NATICN 
IF( (Ko EQs1)2.0R0 (Ko EQ04))G0 TO 1 
KM=8-K 
IF ( (Ke EQ02)20Ro (Ke EQo €) JISW=L 
IFC (Ko EQo3).UR>5 ilgo Exe 5 ) )ISw=2 
GU TO (2:3);,1Sh 
K=2 OR K=6 REGION DETERMINATION 
2 TA=X(2)4P(M4+30)4X(6) 
Me=At 2) +P (M+25 )4X(6) 
XC=X (30) 
rele) )17%s16516 
15 IFC (TAaGE0 On) -GRe(TB2LESQ0.))GO TO 4 
ISw=2 
cemrTo 5 
V7 TF((TAdsLE Os ) LORS (TBoGES0.))G0 TO 4 
TSWw=2 
Bee tTO 5 
TSWw=1 
GO TO (8,9),1SW 
XS=0o 
XSO=0. 
XST=0. 
RETURN 
K=3 OR K=5 REGION DETERMINATION 
Beepa=X(2)-P(M4+30)%X(5) 
Wie (3) —PCM4+29) X05) 
XC=K(54) 
IF(X(5))19,18;18 
18 IFC (TAoL Eo Oo )oCRo (TBoGE000))GU TO ¢é 
ISW=2 
es {0 7 
Bete? (TAGCGE. Oc} oORo(TBolLEo00) GU TO 6 
[SW=2 
oo tC 7 
TSwW=1] 
G9 TO (10,11);15SW 
BEGIN SELECTEG SECCNOARY DRAG CALCULATIONS 
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ww Or 





8 TF(KoEQe2)G0 10 14 

K=5 OR K=6 REGION CNE 
12 N=M+1S+(K-5)27 

OXS=ABS(X( KM) (PON DEXCKM) FEC N-LIEX (CK) D4 
LPUNF+1) °SIGN(15 ep XCKM)DEXCK EXER) 

XSO=XS 

XST=XS 

XS=XS#XC 

RETURN 
mer tKoEQs2)CG0O TO 15 

K=5 OR K=6 REGICN TWO 
moeN=Mt14e(K~-5)%7 

OXS=PCNI4X(KI-ABSOX(K) SP ONt3) SXCKMPZABSUX(K) ) 4 
LSIGN( 25 sXOK))2EX(K)EXCKD EC PINF20 2 (OX (KNISXCK) 242 ) 4+ 
2Z2P(N+#+1)) 

XSO0=XS 

xST=XS 

XS=XS* XC 

RETURN 
meer tKGEQ,5)CO TO i2 
K=2 OR K=3 REGION ONE 
14 N=N+(K-2)47 
OXS=ABS(X(K) (POND =X(K) +P (N41 AX (KMD) + 
LP(N#2)%SIGN( Los X(K DG XK DE XCKM) 

XSO=XS 

XST=XS 

XS=XS" XC 

RETURN 
Meir tKoEQ.5)GO TO 13 
K=2 OR K=3 REGION TWO 
15 N=M+37 (K~-2) #7 
ees IGNL 1s eX (KMIPBXCK)EXOK (PONDS CXCK) ZXCKM) D4 PONTI )) 
L4+P (N42 )2X (KIS ABS(X (KM) ) tP (N43 = XC KMS ABSOXCKM)) 
XSC=XS 

XST=XS 

XS=XSBXC 

RETURN 

END 
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APPENDIX A7 


TER D3 SUBROUTINES (EFFECTORS 
PSUBROUTINE TANKS( Pals Ur NT + PG) 


oe Ste kk Mey ee ek ae TSH oh a A Baise yd ee de py aces zo. Sid shah pe) op alae 


LBROUTINE TANKS 










BePOSE 
JO COMPUTE THE VEHICLE WEIGHT AND CENTER OF GRAVITY OF 
MeGeENGCRAL OCEAN VEHICLE BASED UPON ITS TANK LOADINGS 


LBROUTINES REQUIRED 
NCNE 


DESTRIPTICN 

CHAPTER D3sMaNcHAYES THESIS, ,MIT,1971 »sNAME DEPARTMENT 
 Ssetse Kescksehaee heh hea ae eae be ha A oe Ea Ny oboe ak he) iy teat 
DIMENS ION P{i);U(1)9PGE1) 

DHW=O. 

ADW=00 

YOwW=0c 

ZDW=06 

J=h 

DO 1 T=i;NT : 
D=U{(I)-P(J) 

OW=DWt+D 

K=Jt+NT 

XOw=XOWtD=P(K) 

K=K4NT 

YOu=YDW+D7P(K) 

K=KtNT 

ZOW=ZDWADYP(K ) 

yo J+] 

1 CONTINUE 

WT=PG(1)+0W 

PG(2)=(PG(2)=PG(1L)tXDW) /bT 

Pet 2)=(PG( 2bePG(1)+YOR) /kl 
PG(4)=(PG(4)=PG(1)+ZDW)/WT 

PG(1L)=\KT 

RETURN 

END 
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SUBROUTINE GRAVT(HyAyNePyX3K,L) 


r a oc, aie abe utp at cis ate Le wt, of eS > a an aes = e.g Be, 
NS Ge HS F2 Ht SER TTR Sy. op ee a ON eae ceeds of 


fd CGR feb hae hay ye yeaa Rob tig apd op 
SUBROUTINE GRAVT 


PURPOSE 

10 COMPUTE THE GRAVITY FORCES AND MChMENTS CN A GENERAL 
JCEAN VEHICLE BASED UPON ITS WEIGHT,BUUYANCY,CENTERS OF 
GRAVITY AND BUOYANCY;AND VEHICLE AKGLES 





SU2ROUTINES REQUIRED 
NCNE 


DESCRIPTION 
CHAPTER D3ysMoNo HAYES THESIS MIT,i971,NAME CEPARTMENT 


Bab PK BE Peaks Apo eyed SNe ck nhy Aso kaa: feel yg het aocge ema 

LOGICAL AM 

DIMENSIGN A(2)5P¢1)—X(1),0(01) 

WYB=P(1)-P(5) 

SPH=SIA(A(N)) 

CPH=CGS(A(N)) 

STH=SIACA(N*1)) ; 

CTH=CCS(A(N4t1)) 

AM=". EQ:1 

DO 10 IT=1,;K 

J=L(1) 

TF CAM GANDo (Jc GT33) JEN +3, 

GO TO ()225333415:69738:9)e-5 < 

femct COUATIGNS FOR BOTH ZERO AND NON-ZERG. Ce Bo 
PAC J)=-WMB*STH 

G3 TO 10 
2 X(J)=WMB=CTH=SPH 

GO TO 10 
3 XC J)=WMB*CTH:=CPH 

GJ TC 10 

MOMENT EQUATIONS FOR ZERO CENTER CF BUOYANCY 
4 X(JI=(P(3)2CPH-P(4)"°SPH)2PC(LI= CTH 

so ic 10 
5 X(J)=-P(1)#0P (2) "CTHECPHtP(4)5STH) 

GO ¥O 10 
S X(JI=PCLIRe(P( 2) 2CTHUSPHIP (3 )8STH) 

GO TC 10 

MCMEAT EQUATICNS FCR NCN~ZERU CENTER OF EUOYANCY 
TOX(J- 3) =CTHE( (P03) 8P(LI-P(7)2P (5) ) XCPH-(P(4)%P (1 )-PCS 04 

£P(5))#SPH) 

GO TO 10 
BOX (J—3)=-(P(2)8P11)-P(6)P 05) )2CTHECPH-(P(4)*-P (1 )-PC8)* 

YP(5))°STH 

GO TO 10 
90X (J-3)=(P(2)5-P (1) -P 16 POS) PECTHYSPHt (P (3) PCLI-PC7)* 

BP(5))#STH 
10 CONTINUE 

RETURN 

END 

~42)~ 
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MeerewUTING SHCAL(PsMeX,U>N, ee ea ¥ KE yl) 


SN GOR FH CA Mee ee ee eR nee Pe Rot ee erat ay ee 


SUBROUTINE SHCAL 


Cala Aa aly Oey YAS BoE RN: 


PLRPOSE 
TO CALCULATE THE FORCES AND MOMENTS GN THE DSRV CAUSED 
BY SHROUD DEFLECTION ANGLES 


SLBROUTINES REQUIRED 
UTCGM,ASCOM,RGCCM, SINQ 


DESCRIPTICN 
CHAPTER D3;sMoNoHAYES THESISsMIT,1971 »NAME CEPARTMENT 


-— et As Of 


4 oe oe ed ee) ee a site? at cp ntewty Jy 03 oe ae a ee . 
SoH PRM RUPE I A KA Pe ah SS apie pespus ciety ed erable Jeajea, seats deo, shame cei Aese 


DIMENSION PL) Xt Me, xs thre 
DIMENSION A(18);UT(3),FU(3) 
IF ( (KBs LT. 230 ANDo (L(1)0EQ04))60 TO il 
XSHR=PUM+4 7) 
CALL UTCOM(U,NyXSHR3A) 
RAD=57525577S5 
CALCULATE U2S(1) 
VSQ=0>5 
DJ 2 1=1,3 
UTC I )=05 
DO 3 K=1,KB 
J=L(K) 
MN=I4+3%J-3 
UTC LIRHUTCIVAACMNDS X00) 

BeCINTINUE 
VSQ=VSQOFUTCISUT(1! 

BPCUNTINUE 
CALCULATE SHROUC ANGLE ALPHA-S 
EPS=P (M450) 
MeaLlL ASCOM(UT.AS,ING,EPS;s VNS) 
IF (ASoLTs Oo JAS=AS436141592E5 
AS=AS™ RAD 
TEST INC AND INCREMENT A SHROUD RUN PARAMETER 
TF( INDSEQs1)PCMF51)=P{M 451) 410 
COMPUTE LIFT ANC DRAG COEFFICIENTS 
CALL RGCOM(M,NL,P,IND,AS,CL) 
MNEM+ BNL + 4 
CALL RGCCM(MN,ND;P,IND, AS ,CC) 
emeure VLIFT AND VDRAG 
B=05 53 P (M449 )2VSQ¥P (M448) 
VLIFT=8*CL 
VDRAG=B#CD 
CGMPUTE VNF AND FU(1) 
AS=AS/RAD 
CAS=CQOS(AS) 
SAS=SINCAS) 
VNFH=VLIET®CAS+VDRAG¥SAS 
FU(CLI=VLIFT*SAS-VDRBAG@CAS 
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TEST VNS FROM ASCCH 

TFEI(VNScEQsG>) VNS=EPS 

met 2)=-UT(2)4VN\F/VNS 

FU(3)=-UT(3)*,VNF/VNS 

SOLVE SIMULTANEOUS EQUATICNS FUR SHROUD FCRCES 
XS$(1)=FU(1) 

5 (2)=FU( 2) 

XS(3)=FUC3) 

CALL SIMQ(A;XS;3,iND) 

TEST SIMQ INDICATOR 

IFC INCOEQ,0)GO TO 4 

WRITE(6;5) 

5 FORMAT(1X,*SIMQ IN SHCAL GIVEN SINGULAR SYSTEM! ) 
DO 6 K=1,KB 

KN=L(K) 

XS(KM)=05 


SOON TINUE 


RETURN 

SELECT AND CALCULATE MOMENTS 
09 ?@ K=1,KB 

MevetKh)yclL7Te25)G0 TO 7 

mrrrted.s £965 )XS(5)=XSKR*XS(3) 
TFC LOCK Ye EQ06)XS(6)=-XSHR¥XS (2) 
CONTINUE 


1 XS(4)=05 





RETURN 
END 
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SUBROUTINE RGCOM(M Ne Py1yXy¥ 
Be ete ge cke sit sie ste ape Fes jeog ope HS ap MEE eo op age ce teak ok phytate os gb eee equ yo. ao Qa dou Baa 
BRIUTINE RGCOM 


POSE 
TO COMPUTE A LINEAR VALUE WITHIN A RANGE GIVEN STRAIGHT 
LINE SLOPES AND INTERCEPTS 


SUBROUTINES REQUIRED 
BENE 


ESCRIPTICN 
E SUBROUTINES SFCAL AND TECAL 
CHAPTER D3,MsNoHAYES THESIS sMIT,1971 yNAME DEPARTMENT 


Be Rac Ree RPS RE RRA EE, A ge RS a le ey pa a ep aa 
DIMENSION P{1) 
WO 1 K=1,N 
IF(XoGToP(M+K))GQ TQ 1 
T=K 
MV=MEtN +16 
Y=P (CMV) Xt+PCHVEIN) 
RETURN 
CONTINUE 

=-] 
Y=0o 

RETURN 

END 


-h2h- 


























SUBROUTINE ASCOM{UT,As,I,EyV) 
Bp OR REM RS Re og. og Lobe oh ae ay Lonah yy Bo mak hag eal ep a kay 


3ROUTINE ASCOM 


10 COMPUTE SHROUC ANGLE ALPHA-S 


BROUTINES RECUIRED 


SCRIPTICN 
SEE SUBROUTINE SHCAL 
CHAPTER D3,NoNoHAYES THESIS:NIT,1971;NAME DEPARTMENT 


PP Fe ee aE ehcp oe y eet: fe ps he) gap eed Seok as fobs, Be el 
PMeNSICN UT(1) 

IT=0 

meot Uitl) FOR ZERO 

MeeUI(i jc EQ.0.)G0 70 1 

Bere SORT(UT( 278UT (2) +UT(3)4UT(3)) 

A=ATAN(V/UT(1)) 

RETURN : 
1 UT{(1)=E 

T=] 

GO TO 2 

END 


BiDs - 


uy 













SEROUTINE UTCCM(U,N, XA) 
se Ae Sostecks Ma tee ake Assis op ake ab ase Marea ea kode hb dhe geet ad aaa decks bol ea tack pyc ek 


2ROUTINE UTCOH 


JaPOSE 
TO COMPUTE THE DSRV SHROUD ANGLE TRANSFORMATION MATRIX 


SLBROUTINES REQUIRED 
NCNE 


Bes cRIPTICN 

Bee SUBROUTINE SHCAL 
CHAPTER D3yMoNoHAYES THESISsMIT,1S71,NANE CEPARTNENT 
RR Bikes Foe Re ea, pe de eg haem Bete agate os hacyee sd again ac sbcbabg egy 
Meee NOICN U(1),AC1) 
er=COS(U(N)) 
SP=SIN(UCN)) 
CY=CCS{(UCNt1)) 
SY=SIN(UCN+1)) 

ati y=CY#CP 

m2) =-SY*CP 

A(3)=SP 

A(4)=SY 

A(5)=CY 

A(6)=0., 

A(7)}=-CY<SP 
BL8)=SY*SP 

A(9)=CP 

A(10)=0. 

Al11)=Co 

A(12)=05 
Al(13)=X=A(7) 
AC14)=X"A( 8} 

A(15 =X" ACG) 
A{1L6)=-X*A(4) 

PCL? )=-X*A(5) 
A(18)=-xXiA(6) 
RETURN 

END 
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PIAA ADYOAAO™AIiAAIAAIDAN 


SuaROUTING PREAL(P rH; Ur NaNP XP, KI 


GOR PACE AS MO AE Pa ye) hd ec Bedi. dal equkeege agp dela st ma 
SUBRUUTINE PRCAL 
PURPOSE 
TO CALCULATE THE FORCES AND MCMENTS CN THE OSRV CAUSED 
3Y PROPELLOR ROTATION AND RCTATIONAL ACCELERATICN 
SLSROUTINES REQUIRED 
NCNE 
BesCRIPTICN 
CHAPTER D3sMoNoFAYES THESISsMIT,1971,;NAME DEPARTMENT 
rum ee eugene Shs He Sie Shes sc te Se Meo oh hooks cet vps: ae ae ob oh eee eg ecg. oh St ae heey teak. gp che ied te dey deage ten Mi 


einen | x0 .Uer) 
BSGICAL A;E,C 
PM=P(M+36) 
VP=X (2 )4+PMuX (6) 
ewP=X(3)—PMEX (5) 
GO TO (34$92533%4%,5,6);K 
SURGE REGION DETERMINATION AND EQUATION SELECTION 
1 A=X(1).GEo 03 
B=U(N)5GEc Oc 
C=(UC(N)I-P( M435) 8X01) )0CGE0 Oo 
PV=P (M432 )°U0N)®SQRT (VP VP4+nP-2WP ) 
IF( As ANC5C)ISW=1 
IF (Ac ANC aNOT OC) ISW=2 
IFC ONGTo Ao ANDo B) ISwW=3 
TF{oNOTo (AsORGB) )ISWH4S 
GO TO (73:8,;9,10);1SW 
PROPERLOR SURGE EQUATICNS 
TOXP=P(M)BUCN)*ABS(U(N) )4P 0 M41) 4X02 DFUIN) + 
VP(MFt2)2X(L 8 XC1L)+PV 
RETURN 
ZOXP=P(HFZB) SUCNIEABS (UN) D4 POMS) EXCL IUCN) + 
IP(MES)EXCLIEX(L)+PV 
RETURN 
JOXP=P(M+6)°FU(N)= ABS (UCN) )#PUNET)® XCL)UCN) + 
LP(Mt8)=X(LIYX(LI+PV 
RETURN 
LOOXP=P(Mt9)2U(N)ZABS (UCN) DFP (M410) 2X (LY SUON) + 
LP(M#i1 b4 XC LE XC LT) +PYV 
RETURN 
SWAY REGIGN DETERMINATICN AND EQUATION SELECTION 
2 TF(U(N)oLT205)GO TO 1) 
PROPELLGR SWAY EQUATICNS 
XP=P(M412)2U(N) VP 
RETURN 
Ll XP=P(M413)%U(N) VP 
RETURN 
HEAVE REGICN DETERMINATION AND EQUATION SELECTICN 
Per (UC(N)oLT.0.)/GO TO le 
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XP=H=P (M414) SU CN DEP 
RETURN 
PO XP =P (M415) UCN) HYP 
RETURN 
RCLL REGIGN DETERMINATICN AND EQUATION SELECTION 
4 A=X(1)cGEo0s 
B=U{N) o0CE205 
mere (N)—-POMt35) X(1)) 6GEo Oc 
PV=P (M433 )°U0N)"SQRT(VP=VP4WP ¢WP ) 
PD=P(¥434)"°U(N4] ) 
TFC Ao AND C)ISW=1 
mens MNCs oh OT.C )ISW=2 
IF {oNQTo As AND. B)ITSW=3 
IF (oNOTo CA, 0R2B)) I SW=4 
GU TC (13,514,15:516),I1SW 
PROPELLER ROLL EQUATIGNS 
LZ0XP=P(M4+16)=U(N)“ABS(U(N) ) 4P(4427)2xX01)"U0N) + 
LP(MA+L 8)5X(1L)8XCL)0+4+PV+4PD 
RETURN 
L4O0XP=P (M419) 2U0N)+ABS(U(N) 2 4P0N420)4 X00 DSUCN} + 
IP (M420 5¢X(2)"X01)4+PV4P0 
RETURN ) 
LSOKP=P (M422) 2U(N) ABS (UCN) ) 4P0M423)&X (1 SU(N) + 
LP(M+24 )2X( 1) X(2)+4+PV4PD 
RETURN 
LSOXP=P (M425) 2U(N) ABS (UCN) ) #P(M426)2X (01 )2U CN) + 
LP(MF2]7 EXCL) X01) +P ViPD 
RETURN 
BeerGH REGICN DETERMINATIUN AND EQUATICN SELECTICN 
5 IF(U(N)oLTo05,)G0 TO i? 
PROPELLOR PITCH EQUATICNS 
XP=P(M+28)"=U(N} FWP 
RETURN 
1? XP=P(M429)4U(N) WP 
RETURN 
YAW REGION DETERMINATION ANC EQUATIGN SELECTION 
6 TF(U(N)oLT000)GO TO 16 
PROPELLQR YAW EQUATIONS 
XP=P(M+30)°°U(N)#VP 
RETURN 
Be XP=P (M431) UCN) VP 
RETURN 
END 


28 








ca pagal a a MyUaNy XyXTK) 


a - ’ — bei 
atid ch eke pe: 994404034 ee ae ee VG Fae ep Zeal. 


3 ch Bef Ty} a a a 
@ROUTINE THCAL 


URFOSE 
TG CALCULATE THE FORCES AND MCHENTS CN THE DSRV CAUSED 
BY THRUSTER PROPELLOR RSOTATICKS 


SUBROUTINES REQUIRED 
RGCGM 





meSCRPPTICN 
CHAPTER D3;sMsNcoHAYES THESIS MIT,1971 NAME CEPARTMENT 


Ne ae ee ee ee ce ee feo ee oe be 2 ba a eS 
SHEADY STATE EQUATICNS USED IER THRUS TER CALCULAT 1ONS 
DIMENSION P(1),U01),N01),X(i) 
GI TO (1425939455 ,6)yK 
MARUSTER SURGE EQUATICNS 

lL XT=9c 
I=N(2)-1 
NT=NO1) 

JS=4 

JR=-1 

4V=M+60 

D3 7 J=i;,NT 

JS=JISFIR 

IJ=I+J 

JT=JSS+2 

MV=EMVtJIRELC 
UI=ABS(U(ITJ)) 

TF (UIe EQo00}GG TO 16 
A=X(1)/uU! 
Py=P(M+128) 
IF(CAcGToPV)A=PV 
PH=P(H+127) 

IF CAoLToPWIA=PW 

Gat RGCOM(HV,N( JT) 2P,IR,A, TS) 
XT=XT#UCTIISUCTIISTS 

im JR=-JR 

feCoN TINUE 
MehURN 
THRUSTER SWAY EQUATICNS 

2 XT=0c 
I=N(2)-1 
1Sw=0 
JT=3 
MV=M 
PV=P(¥V4+1238) 

PW=P(M4+127) 

me 1+) 

UI=ABS(UC(1)) 

IF(UILEQ,001G0 TO 1? 

-l29- 





17 


13 


13 


1s 


ai 


MeaxtL) Jul 
TFCAoGToPVIA=PV 
IFC Ao L To PW) A=PH 
CALL RGCOM(IMV,N(JT),P,1 
XT=XT#uCl PX“ ABS( UCT) TS 
MV=MV425 

JT=JT+1 

ISW=ISWtl 

me 10 (h2,13),1SW 
RETURN 

PAU STER HEAVE EQUATICTCNS 
XT=05 

I=N(2) 434 

ISW=0 

JT=3 

MV=i4 

PV=P (M*128) 

PW=P(M+4+127) 

|S ee 

OreASS (UCI) ) 
mevUlce@.0,)GG 10 18 
A=X(1)/U!I 
IF(AsGToPVJA=PV 
IF(AoL To PW)A=Ph 

CALL RECCOM(IMVN(JT)5P,IRyA,TS) 
R= XPFUC] PSeABS(UII)D)¥TS 
MV=MV425 
JT=JT+] 

ISW=1Sht+l 

GO TO (24,15),15SW 

RETURN 

WMO STER ROLL) EQUATIONS 
XT=00 

RETURN 

eames lt ER PITCH EQUATICNS 
XT=00 

L=N(Z) 

JV=M4).22 
XT=XTHP(IVIEUCT)*®ABS(UCT)) 
L=[+] 

XT=XT#P(IVIZUCT )=ABS(UT)) 
TSh=0 

MV=M+4+76 

JT=7 

JV=Mt120 

PV=P (M+128) 

Pw=P (M4127) 

T=I+] 

UI=ABS(U(I)} 

Pet UloeE@s0.)GO TO 19 
A=X{1)/UI 

IF (Ano GToPV)A=PV 

IF (AoL To PW) A=PV 


RyA,TS) 


-4,30-- 













CALL RECOM(IMV,N(JT)2P31R,4;TS) 
XTHXTHP (IVI UCT ABS (CULT) = TS 
LS MV=MNVE22 

JV=JVt1 

were J T+) 

TSv=1SW+1 

maw pO (859), 1SW 

S§ RETURN 

THRUSTER YAW EQUATICNS 

6 X1=0. 

I=N(2)-1 

ISW=0 

MV=H4+76 

JT=7 

JV=H44123 

PV=F(M+i28) 

PH=P(M+127) 

10 I=I+i 

UI=ABS{(U(I)) 

IF(UI-ZESe00)6GG TQ 20 
A=X(1)/UI 

IF {AcGToPV)IA=PV 

IF( Aol To Pw) A=PW 

CALL RGCCM(NV, N(JT),P,1R,A,TS) 
XT=XTHP(IVIEUCT)SABS(UCT))4TS 
20 MV=MV422 

JV=JVt1 

JT =JIT+1 

ISW=1SWti 

| GO TC (10,11),1SW 

P l=1+i 
XT=XT#Pl(IVISBUCI)FABS(LI IT) ) 
[=I+ji 
XT=XT#P(IV)--UCT)4ABS(U(T)) 
RETURN 

END 





apie 















SUOROUTINE COCAL(P sM,X,XC,K) 
‘ a ae ne Rly is ee FREY GY PR ad Bye ye ha hs, 


TO SELECT TKE CCNSTANT FORCES ANO MOMENTS TO 8E 
APPLIED TO THE DSRV 


UBROUTINES REQUIRED 
NGNe 


SSCRIPTICN 
SHAPTER D3yMoNsHAYES THESISsMIT) L971 »NANE DEPARTMENT 


eae a ae SM te OY. anresescy ky ca Ro ye wy | sete chapel ht ee Ba Sa 
“DIMENSICN Phi) yX(1) 
MP=MtK~-1 
GU TO Mie 293342526) K 
1 XC=P(MP) 
RETURN 
2 XC=P(MP) 
RETURN ‘ 
= XC=P (MP) 
RETURN 
4 XC=P(MP) 
RETURN 
XC=P(MP) 
RETURN Me 
XC=F (MP } ’ 
RETURN 
END 


2iee 





SUB QUTINE Ae ae P, Wa Xoe KyN) 
EN RE ee ee fe eae tee ee RE Loe Se i ft Set kt ee 2 ks 2 
ROUTINE XDI ST 











SAUSS(IBM/SSP) 


SSCRIPTION 
CHAPTER D3;MoNOHAYES THESIS, MIT,1971 sNAME CEPARTMENT 


PMG dee Be ey ab oe ye a dea pea) ie kN es Geog Mtg de iy Ga al 
DIMENSION 1¥(4),P(1) 
IX=1(K) 

MV=MtK~-) 

AM=P (MY) 

MV=MV4N 

S=PCUMV} 

CALL GAUSS(IX,S2AM;sX) 
Pet URN ~ 

END 






I(K) = 


fever 











CHAPTER D5 SUPROULINES 


PWV A?AANAYDAIOYIAANAAINANAND 


APPENDIX 48 


OVDER, GRADIENT 
ons eo AN at op ae KBr baXykPy Lt P»P,F pF NE ) 





ie Ue KA CRONE eA eR ee a mR die He tie hae Sick oitiveg. de N oft squat ede sha Aegttesi of 


SUBROUT INE “OVDER 


PURPOSE 
eee rMPUTE SELECTED STATE DERIVATIVES WITH RESPECT TO 
SECOND-DEGREE COEFFICIENTS AND PARAMETERS FOR A 
GENERAL OCEAN VEHICLE 


SLBROUTINES REQUIRED 
TANKS sACALCyAZBINVIMINV, XDDER, SEDER, PRDER,THDER, SHDER, 
XFDER,XPDER 


meSCRIPTICN 
CHAPTER D5yMoNC HAYES THESTS2MIT,1971,NAME DEPARTNENT 


4 29 ofa te feet vy b) » ola ele 2%, A Oe a E) 5A 4 te Bo uboigt we ase aclitce Cie Be oly rt ce oe © eke 3. fe ew ane 
mR ROE RecbR yok eee kage bk Reed. Rooks Gobksec dh bee pagayel Sad hicks ged 


Wi 


i: 
ol 
> 


PNTEGER AV »XF 

MIMENSTON WE(1) ,UCL)»NEC1) AVC lL)» XFL) LEC 1) oh C1) yXC1) 
DIMENSION LP(1i),P(1),F (1) 

DIMENSION A(36) ,ATH(9) »NT(14),MM(6), PG(B)yPC(8) »XDU3 6) 
DIMENSION XS(36),XFDO( 756) ,XPD(756) 
AT=MECLT)-1 

D0 5 KT=1;,& 

PG(KTJ=PCUMT+KT) 

CONTINUE 

mimeo NEo1)IGO TO i 

CALL YANKS(P,ME(10),U,NE(1),PG) yo 
MG=ME(18) 41 
G=P (MG) 

CALL ACALC(P;PG,G,A;,;KB;5L) 

BEGIN INVERSICN OF A 

IF(KBoNEo1L)GQ TO 2 

meee til)aEQ,0,.)CGO TO 3 

A(L)=1./A(1) 

cy 10 86 

IF(KB2NE22)GO 0 4 

DET=A(1)'*4A(4)-A(2)#A(3) 

Bet ocAsEQme. )GO 7O 3 

DET=1.0/DET 

AH=A(1) 

ACL) =A(4)"DET 

AM 2)=-Al(2)*DET 

A(3)=~-A(3)*DET 

A(4)=AHSDET 

GO TO 8 

IF(KBoNE03)GG TO 6 

DO 7? K=1,.9 

ATH(K)=A(K) 

CONTINUE 

CALL A3INVCATH;,A) 

GO TO 8 


6 CALL MINV(A;KB;DET,NT;MM} 


ahi) 





10 


LW 
+s 


1+ 


-~ - 


33 


-2 


PF(DET,60,05,}G0 TO 3 


ca 10 86 


IKB=KB SKB 

DJ 9 K=1,IKSB 
A(K}=0, 
CONTINUE 
WRITE(6,10) 


FORMAT(CAXs *SINGULAR DETERMINANT IN OVDER, SETTING F=05"} 


GO TO il 
¥C=ME(18) 
PC1i)=PG(1L)I/P(MC+) } 
PC(2)=PG(2) 
PC(3)=PG(3)} 
PC(4)=PG(4) 
PC{(5)=P(37) 
PC{(6!}=P(39) 
PC(7)=P(42) 
PC(8)=P(43) 
NTCL)=KE(4) 
NT(2ZJ=NE( 9) 

DO 34 1=3;8 

NTC T=NEC1+10) 
NTC I+67=NE(1+19) 
CONTINUE 

DI 12 KM=1,KB 


K=L (KM } 

DI 13 KN=1,KB 
4A=LCKN) 

Nh FHNt6%(K-1) 
DX=05 


CALL XODER(AVs XFyPyPCsXsDXekKsMeKB7L} 
IF(ME(2)2NE,1)G0 TO 14 

CALL SEDER{P,ME(11),X,DOXS,NF) 
DOX=DX+OXS 

IFCHE(4)-NE.1) GO yO 15 

CALL PRDER(P,ME(13)9x%_,UsNE(8) »NE(3) »OXP,NF) 
DX=DX+CXP 

Mm Cie} S}oNE,1)GO TO 33 

CALL THDER(Ps5ME(14),UsNT: XyDXT1NF) 
OX=DX+DXT 

XD(NF}=DX 

CONTINUE 

CINTINCE 

IF(ME(3)0.NE01)GO TO 16 


OCALL SHDER(PyME(12)2XyU,NE(7) NEC 2) sNECI1I)yNECL 2), 
INE(20),NE(21),XS,KByL) 


NV=1 

DO 17 KM=1,KB 

K=L (KM) 

CO 18 KN=1,KB 

M=LCUKN) 

NFHMtG°(0K-1) 

FI(NVI=XD(NF)*+XS(NF) 
-435- 





18 


14 


Zl 
20 
13 


33 


ET 


NV=ENV4) 


CONTINUE 


CONTINUE 

Meehe{3).EQ.1)GO TO 19 
NV=1 

DJ 20 KM=1;KB 

K=L(KM) 

M=L(KN) 

NF=M+62(K-1) 

FI(NV)I=XCCNF) 

NV=NV+1 

GUNTINUE 

CONTINUE 

IF(KFOEQ,0)GO TO 24 

Meme XFOER(AV,XF;P;PC,X,XFO,KF,;LE,KB,LsME(1i1) ) 
ND=0 

NL=] 

NB=NV-]1 

DO 23 Ki4=1,KB5 

M=L (KM) 

09 35 JM=1,KB 

J=L( 5M} 

DI 36 IM=1;5JM 

I=L( IM) 
TJMaT+( 5S" 0 J-2))/24+215(M-1 ) 
IF(NLoGTOoKF)GU TO 37 
PECEFANE) o GT,IJMIGC TO 36 
IF(LF(NLJoEQoIJM)IGO TO 39 
NL=NL+] 

G93 TO 38 

ND=ND41 

DJ 22 KN=1;KB 

K=L(KN) 

TJKX=Kt+62 (1 UM-21) 
NK=NBtKNt+KBe(ND-1) 

Peer Ki=XFOC ISK) 

CONTINUE 

NL=NL4Al 

CONTINUE 

CINTINUE 

CoNwd NUE 

NV=NVtKBEND 

IF(KPo EQ;0)G0 TO 25 

CALL XPDER(P,ME,U,;NE,X XPD, KP,LPsKB,L yNT) 
DO 26 KM=1,KP 

K=LPCKM) 

DO 27 KN=1,KB 

M=L(KN) 

NF=HM+673(K-1 ) 
F(NV)=XPD(NF) 

NV=NV41 

CONTINUE 


ly 36- 





6 CONTINUE 

BEGIN DERIVATIVE TRANSFORMATION 
5 IR=-0 

IK=0 
NF=KBtKFtKP 
pe 29 K=1,NEF 
00 28 KM=1,KB 
IK=1K+]) 
PG(KMI=FCIK) 
meeGOHTINUE 
pa 30 M=) ,KB 
IR=IR+1 
JI=M-KB 
IB=0 
F(IR)=0¢ 
CU 3h J[=1,KB 
JIH=JIAKB 
I18=1B+1 
 FCIR)=FCIR) FAC JT }*PGCIB) 
Bt CONTINUE 
BPO CONTINUE 
293 CCNTINUE 
RETURN 
NF=KBtKF+KP 
TKB=KB#N\F 
DD 32 K=1;I1IKB 
F(K)=0c 
CONTINUE 
RETURN 
END 






















-_-* 





Be R Rt SSeS esp eo be Re Rh, gpy eat epee dhe ha a pk ad 
SUZROUTINE XDDER 
PLRPOSE 

TO COMPUTE THE STATE DERIVATIVES OF THE SECCNO-DEGREE 
meer riICieNlT--FUNCTIONS OF AN OCEAN VEHICLE 


SUZROUTINES REQUIRED 
XFUNS 





DESCRIPTICN 
CHAPTER D5;MoNoHAYES THESISsMITs 1971 yNANE DEPARTMENT 


MS Be Mee Sy eRe Sp Pe eB RR Ree AS es ph Rep ne ap tg ANCE EE 
INTEGER AV _XF 
DIMENSION AV(1) eXFC1)ePC1).PC(1)sX(1) LCL} 
CX=0o0 
mo i jP=1,K8 
T=L(IM) 
DO 2 JM=IMN,KB 
J=L (JM) 
TJK=14+(J@(J-1))/24+215(K-1) 
meade) o £Q5,0)G0 TO 2 
IFC CIoNEs Md 0 ANDo (JoNEoM))GO TO 2 
KIJ=1JK+6 
CALL XFUNS(PCyX ek TJS 3XCy_ XF) 
IF( IloEQeJ)GO TO 3 
IF(IoEQ54)GO TO 4 
IFLAV(TIK)1596e7 
5 DX=DX+ABS(X(1))XC 


oe 10 2 
§ DX=DX#X(IPEXC 
G3 T0 2 
7 DX=DX4XC1)FSIGN( Lo yX0 J) 2 FXC 
GO TO 2 
4 TF(AV( IJK) )10311212 
10 DX=DX4X(JIFSIGN(1Lo oX(1) XC 
GO T9092 
me O¥=OX4+X( J) ¥XC 
Ge fG 2 
H2 DKX=DXF+ABS(X( 5) EXC 
GO TC 2 


oe tC WV( IK) 18:9, 

8 DX=DX4+2,0%ABS(X(1))*XC 
GO 70 2 

GS DK=DX+2e OF X(T) EXC 

2 CONTINUE 

f CONTINUE 
RETURN 
END 


alp58~ 





MIMAAMANIADGAINI|YIAYNM 


SUBROUTINE Se MyXsDXS,K) 


MSH HIS TEAC TH ge G8 ye SE of SCO ht eae Rte UL KI A eg day. eK Oe ae eh wate) deere ty 
SUBROUTINE SEDER 
PURPOSE 
TO COMPUTE THE STATE DERIVATIVES OF THE SECCNDARY ORAG 
TERMS FOR THE DSRV 
SUBROUTINES REQUIRED 
NONE 
MesCRIPTIOQN 
CHAPTER DdsM,NZHAYES THESIS »sMIT,1971 NAME DEPARTMENT 
Re sgt ce > OG SRG 2 22 A SEs SS GK A ka ag SE RAC eof oe Ac igs me ets des re cveess,s team ok ade: Le Be. ae. 


DIMENSION P(1),X(1i) 
OGD TO Ulelslslosleodels2slagly ly Selo le4slyEylylslylylyly 
LlrlolsSeleylodsly3ele191,9),K 
l OXS=0_5 
RETURN 
2 TA=X(2)4+P(M4+30) 2X65) 
TB=X(Z2)4P(M4+29)%X16) 
XC=X (30) 
IF(X(€})27326;,26 
25 TFC (TAGE, Oo) 50R0(TBoLE,O02))GO TO 28 
ISW=2 
GU TO 29 
27 TFC (TAsLEs Oo) 30R5 eee CES Os GU. tUsze : 
ISwW=2 
GO TC 29 
28 ISW=1] 
29 GU TO (10,11),1SW 
3 TA=X(2)4+P(M4+30)%X(56) 
TB=XO2)4P(M4+29)2X(6) 
XC=X (30) 
eee (6 ))31,30,30 
ome ((PAGGEs Of) ce ORO (TBoLEoO0))IGO TO 32 
ISW=2 
Ge FG 33 
Peet TAGLE. 05) oORs(TB2GE203)1G0O TO 32 
1SW=2 
GO 70 23 
me 1SW=1] 
me GOeqiO (12,13) ,1SW 
4 TA=X(3)-P (M430) #X(5) 
TB=X(3)-P(Mt29)%X(5) 
XC=X(54) 
IF(X(5))35;,34,34 
BEF ( (TAS LEC Oc )oORe (TBoGE000))GU TO 36 
ISW=2 
GO TO 37 
35 1F((TAeGEoQc ) OR. (TBs LEo 0.) )G0 TO 36 
ISW=2 


ah 39- 





33 


33 


40 


me Wh 
Wows 


46 


47 


3 


590 


51 


eo TO 37 


TSsWe=l1 


Oar TO (124,15),ISW 
PASX(3 }—-P (M430) xX (5) 
TB=X(3)—-P(M4+29)2:X(5) 

XC=X (54) 

peexn(57)29,38,38 

IF ( ( TAoLEs Oo }cORs (TBo GEoO. ) }GO 
ISwW=2 

GO TO 4i 

TFC (CTAsGEc Oc ) >. ORS ( TBe LEo 0.) )G9 
I SW=2 

GOTO 42 

ISW=1 

GO TO (15+2i7)-1SW 
TA=X(3)-P(UM4+30)°X(5) 
TB=X(35)-POCMAt29) X05) 

XC=X(54) 

1F(X(5))43342 542 

IF ((TAc LE Oo )o ORo (TB3GE00s))G0 
ISWw=2 

GO TO 45 

IFC (TAeGEs Oc ) aOR. (TBo LE. Oo) GY 
ISw=2 

GO TO 45 

ISWw=l 

GO TO (18,19);I1SW 
TA=Kt3B3-P{M*+S034%(5) 
TB=X(3B)-PON+2°9) 4X05) 

XC=K (54) 

IF(X(571)47,46446 l 


TFC (TAoLEo Od )c ORO t TBoGE00¢) GIO | 


ISW=2 
GO TO 4S 
IF( (TA, GEs O02 ).0R2>(TB2 LEs 0.) )G0 
ISW=2 
GO TO 49 
ISW=1 
GJ TO (20,21),;,1SH 
TA=X(2)4P (M430) 2X06) 
TB=X(2)4P(M+29)4X1G) 
XC=X(30) 
TF(X(6))51550%95C 
IF ( (TA GEo 00 ) oORo (TBoLEo 00) IG0 
TSwW=2 
SO TO 53 
IF (( TAsLEs Oc }oORe (TBo GE000) IGC 
TSW=2 
GO TC 53 
ISW=] 
OS 10 (22,23); 15¥ 
TA=X(2)4P(M430)2X%016)3 
TB=X(2)4P(M429)%X(6) 
al lO 


ue 


TO 


TQ 


TO 


TO 


TO 


fa 


40 


40 


a) 


44 


48 


43 


5e 


WwW 
IN 





XC=X(30} 
me tme(6) )55,54,54 
mer «(TAGGED O.)cORS(TBoLEoO2))GO TO 56 
ISW=zZ 
GQ TO 57 
omer’ 1) Acti £500 )59R.(TBoGE5,0.0})GO TO 56 
I SW=2 
oe 10 57 
55 ISW=1 
feo) 10 (24,25);ISW 
1D DXS=P(Mj#2, 087 ABS( X02) )4+P (M41) 2X(6)2SIGNO1. 3X2) ) 
DXS=DX8$*XC 
RETURN 
LLOOXS=P (M43 )4STGNO 1. X(6) 1835 O2X%02)-X(2)/X(6) +P (M44) F 
LSIGN(26 9X16) 8 2004%X( 24 4P (M45) HABS(X(5)) 
DXS=DXS“XC 
RETURN 
12 DXS=P (M41) ABS (X(2))4P0M4+2) 4S IGN(169X(2))¥%2,.04X (6) 
DXS=DXS*XC 
RETURN 
1Z0DXS=P(M+3)-SIGN( Lo X(6) 80X42 )/X (6) DE OX02)/7 X06) 
1(-X(2))+P (M45 )#X(2)=S1GN( 10 2X (6) ) 4+P(N46) 226 OF ABS(X(6) ) 
DxS=DXS#XC 
RETURN 
14 DXS=P(M+7) #22 OP ABS(X(3) ) +P CMF8)2X(5)8 SIGN(1.,X(3)) 
DXS=DXS*XC 
RETURN 
Mee O=P(MtLO}MSIGN( 16 2-X(5))43008X(3)%X(3)/X(5)4+P( M411) 
LSIGN(1.0,X(5) )=250"X(3)4PCM412) FABS(X(5)) 
DXS=DX S#¥ XC 
RETURN 
15 DXS=P(M+ 8):*ABS(X(3)) 4POM49 BSSIGNC Los X03) 7&2 04-X(5) 
CXS=DXS#XC 
RETURN 
TTODXS=P (M410) ZSIGN Lo yX(5) 40X03) 7X05) BUX C3) /K05 778 (- 
1X(3))4+P(Mt12)% X03)4SIGNCLo X05) ) +P CM413)-200-7ABS(X(5)) 
DXS=DXS%:XC 
ReETURK 
13 DXS=P(Mt+18)2SIGN( 1. ,X(3))8X(5) +P (4419 20 08ABS(X(3)) 
DXS=CXS*XC 
RETURN 
LIOOXS=P(N*+1L5)2:SIGNELo »X(55 2% 2c04X(3) FPCMtLE)XSIGN( 12» 
TX (5) HGS, OF 6X (3 9S35)/ (X15 )%X05) 2 4+POM417 PPABSUXCS) 1] 
DXS=DX S*#XC 
RETURN 
20 DXS=P{M4+18)2ABS(X(3)) #P (M420) #SIGNC do 9X03) )¥200*X05) 
DXS=DXS*xXC 
RETURN 
2LODXS=P M414 922, OH ABS (X(5)) +P UMF16)9SIGNO 101 X(5))% 200" C 
1%(3)/X(5) 4% Bo PE (-X03) DFP ONFL TT) ESIGN Lo 9X05) )FX03) 
DXS=DXS*XC 
RETURK | 
22 OXS=P( M425) SIGN 10 oX(2)) 8X6} FP UMF26 P20 OX ABS(X(2)) 
=p) 





DXS=DX S*XC 

RETURN 

PZODXS=P(MF2Z2U7S IGN 1s X06) F2008X(2)4PU N+ 23)4SIGNilo » 
1X6) #40 OF C(XC2)/X 06) PEF 2 YX (2)4P (M4 24)%ABS (X06) ) 

DXS=DXS$2:XC 

RETURN 

24 DXS=PUMF2Z5)4ABS(X02Z)) €PUN4t27) 8S IGN Le X02) )%2007X(6) 

DXS=CXS*.XC 

RETURN ' 

250DXS=P{(Mt21 20 OF ABS(X(6)) 4PUMt23 SIGN Lo X16) )%200*(( 
1X(2)/X%(6) ) F305 *0-X02) 2 4POM424) 2ST GNC 15 9 X06) eX(2) 

CXS=DXS¥XC 

RETURN 

END 


Yh 








’ i Lem 
SUBROUTINE AFOCRCAVYXFyP aPC yXyXFO KF y LF KBol MS ) 
Bem Wears SOS STL LS Pag a Pee PE neha k ee sd bbs Soe ee ee del eR he ed 


SUSRJUTINE XFDER 








PURPOSE 
TO COMPUTE THE DERIVATIVES WITH RES» TO SECCND-DEGREE 
COEFFICIENT FUNCTIONS FOR AN OCEAN VEHICLE 


SUSROUTINES REQUIRED 
XDFNS,SECAL 


DesCRIPTION 
SEE SUBROUTINE CVDER 
CHAPTER D5,HM,N, HAYES THESIS sMITs L971 »,NAME DEPARTHENT 


DRS FEN PAS ie a Ba keep ck at ese eee tt sain pon Bap wae ge dal ek 
INTEGER AVyXF 
DIMENSION AVC 1) XF(CL),P0CL),PCCL) X(1) »XFDC1),LF CL) LUD) 
NL=1 
D3 4 KN=1,K8 
K=L (KN) 
03 1 KM¥=1,KB 
N=L(KM) 
DI 2 J¥=1,K8 
JEL (JM) 
D9 3 [M=i, IM 
T=L¢(1IM} 
mom 1PM (S-1))/2e210M~1} 
Mmeeie(NL>sGT.KF)GC FO & 
PFCLF(NL)I2GToTIJM)GC TO 3 
Meee PtNLysEQ: 1JM)GO TC 12 
NL=ANLE2 
Ga tO 31 
Meir iKoNEsM)CO TO 10 
Meeartige),.£60;0)GC TO 10 
NL=NL +1 
KiJ=IIM+6 
CALL XDFENS(PC,XsKIU2XFyDXaI ND) 
KIJ=I1NM 
TJRP=Kt67 (1 JM-3) 
IF(INDJ.EQ,0)G0 TO 9 
IFC AV(KII))5;627 
5 XFOCIUM)=OX#ABS(X(1) X05) 
mentD 3 
& XFDCIIM)=DX#X(T)FX05) 
GQ TO 3 ; 
T XFDO(IIM=DXEXCTPHABSOX(C IE) 
be 10 3 
10 [JM=K+G" (CT SN-1) 
NYV=24 
Meter (Nb)>EQo.NYVIGO TC 13 
NZW=48 
IF(LFCNL)OEQoNZWIGO TO 14 


283. 


—-ie 
















Sg TO 3 


Ge 10 3 


| op ele SECALOPs MS 9K eXS¢KyXSGy XST) 
XFOCI IMI =XS7T 


3 CONTINUE 
2 CONTINUE 
L CUNTINUE 
3 NL=] 

~ CONTINUE 
RETURN 
END 


3 CALL SECAL( Py MSs XyXSy Ks XSUy XST) 
XFD (1 JM) =XSO 


aol lplin 


a 
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SUBROUTINE XDFENS 


PURPOSE 
TO SELECT AND SUPPLY THE DERIVATIVES WITH RESo TO DSRV 
SECGND-DEGREE CCEFFICIENTS FOR SUBRCUTINE XFDER 


SUBROUTINES REQUIRED 
NGNE 


mesCRIPTICN 
SEE SUBROUTINE XFDER 
CHAPFER D5yMoNeHAYES THESISsMITs1971,NAME DEPARTMENT 


° 2 t. * - . tiscaieths <> i ee oe Oe oe BE eh 23>. 2 


ee ee ee ces Wa SNK SRR Es Sp At So eh me eRe 2 ares. HABH REEMGE ES 
DIMENSION P(1),X41),1(01) 
ISW=1(K-6) 
0GO TO Wee sees 23212 e dois 2s 3ele)9222239192s lets 22 1b sees 
LeasSelo2s2eZ2a1L92s39b92529495),1SWN 
1 D=05 
N=0 
RETURN 
D=1>5 
N=] 
RETURN 
D=SIEN(15,X(1)} 
N=) - 
RETURN ‘ 
JF (X(3)5LT20.)GO0 TO 6 
N=] 
D=lo 
RETURN 
6 D=05 
N=0 
RETURN 
PrPeati)yottT.0.)GO TO 7# 
TFC (X(2)-P(8)2X(1))06To 00 )GO TO 6 
N=], 
D=lo 
RETURN 
T TEC (X(23-P(3)2X (1b) ol T0000 )GO TO 6 
N=1 
D=lo 
RETURN 
ENDO 


° of 4 e 
ps HP WEL 


tw 


Ww 


of 


WI 


“4h 5- 


ins 





SUBROUTINE XPCER{P, pME SUS NEaXaXP 0, KPsLP,KBaly sl 


4 3 = *, =o =", 4 K> 
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SUBROUTINE XPDER 


meR POSE 
TO COMPUTE THe DERIVATIVES WiTH RES. TU VEHICLE AND 
SFFECTOR PARAMETERS FOR AN CCEAN VEHICLE 





SUBRIUTINES REQUIRED 
meeer,PRCEP,THDEP 


MesCRIPTION 
Sea SUBROUTINE CVDER 
BaAPTER DO;MoN HAYES THESIS sMIT;1971,NAME DEPARTMENT 


eemeeee, Bbc: hese a a Be Rh ech Kae a Sie EER CREAR SER ALR HPARS 
DIMENSION PARRY EMECT) ,UC1) »NEC1), X01), XP0( 1) pL Pie eae 
DIMENSICN AT(2) 
KME=9 
KMP=9 
D9 1 JN=1,KP 
J=LF( UM) ’ 
KJ=KME 
IS=] 
DO 3 KM=1,KMP 
KJ=KJF1 
IF({JeoLToME(KJ)IGO TC 4 | 
TS=iSil 

SeecUNT TINUE 

4 DO 2 I[¥=1,KB 
T=L¢1IM) 
N=I+62% (J-1L) 
G3 TO Go O-; is S39, eC, iy L2sl3y 143 21S 

5 XPO(N)=0;2 
GC 10 2 

ee APL ON?) =05 
GO TC 2 

7 CALL SEDEP(P,ME(11)3X_PXr1,J) 
XPD(N)=PX 
GU TO 2 

8 XPD(N) =O. 
GO TO 2 

9 CALL PRDEP(P,ME(13) 9X, NE(8),NE(3)9XPoI,J) 
XPD(N)=XP 
GO TO 2 

10 CALL THDEP(P,;ME(14)2UyNT,XeXToT2 J) 
XPO(Nj= 
GQ TQ 2 

11 XPO(N)=C; 
GU TO 2 

12 XPC(N)=Le 
GQ TO 2 

13 XPC(N)=O¢ 





2 
c =0> 
NTINUE 

TINUE 


~~ 








MAANMNAANAIAAANNANAND 
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Meme RE beste gh ees SF Wp. ie St3). Sek Hy OE Qs ae ACRE Ss gt Mee ara eae cial i avast dtd de ete aby a. aap de 
SUBROUTINE SEE P 
PURPOSE 
TO CGMPUTE THE DERIVATIVES WITH RESo TQ OSRV SECONECARY 
DRAG PARAMETERS 
SUBROUTINES REQUIRED 
NONE 
MmescRIPTICK 
CHAPTER DGsMoNc HAYES THESIS »MIT,1972 »NAHE DEPARTMENT 
mn i ae es Sas MD: DHE Scope is xR tes 2 ape os. tts KK Se at et Sag St ch. ok 3 eee ah ate: Quake oe Hee Braj ae ee oe 


DIMENSION P(1),X(1) 
INITIAL SECCNCARY ORAG REGICN DETERMINATION 
IF( (Ko EQo 1) 290Re (Ko EQ04))GC TO 1 
KM=8-K 
ITF( (Ko EQco 2)50R0 (KO EQs6)) 1 SW=1 
IF ( (Ka EQ33),0R5 (Ko EQ.5) )ISW=2 
GU TQ (2,;3),1SW 4 
K=2 OR K=5 REGION DETERMINATION 
2 TA=X(2)4P(M430)"X(6) 
TB=X(2)4+P(N4+259)-4X(6) 
XC=XK(20) 
IF (X(6))17215,16 
16 ITF (( TAdGEo Oo )oOROo(TBoLE,00))GI TC 4 a 
ISW=2 5 
GO 10 5 
17 IFC CTAoLE® Oo )o ORs (TBoGE000))IG9 TO 4 
ISW=2 
Gamid 5 
ISW=1]1 
GO TO (8;9),] Sk 
KS=O0o 
RETURN 
fo OR Ke5 REGION DETERMINATION 
SaA=X(3)-P(M+30)%X(5) 
TB=X(2)-P (M429 )%X(5) 
XC=X(54) 
ITF(X(57)19;18,18 
Mate {{ TAcl Eo 0.) 00Rs (TBoGE.00))GVU TO 6 
ISwW=2 
GO TO 7 
13 IF( ( TAoGEo 0s )as0Rce({TBolE.00))GO TO 6 
ISw=2 
GO TC 7 
6 ISW=1 
moo yO (10-11), 1S 
BEGIN SELECTED SECCNDARY CRAG CALCULATIONS 
8 IF(KoEQo2)G0 TO 14 
K=5 OR K=6 REGION ONE 


lp h18 


mm Ui of 





20 


Zl 


13 


22 


23 


el 


NE=Mt1LOFCK~5)4E7 

IF(JoNEGNICO TO 20 

XS=ABS (XCKM) ) "XC KM) XC 

RETURN 

N=N-]} 

PeRVoNEoNIGO TO 21 

XS=ABSCKCKM) )@X(K) EXC 

RETURN 

N=N+4+2 

IF(JoNEON)GO TO }] 

XS=SIGNL1lo yX (KM) ) EX (KDE XCK)SXE 

RETURN 

mane eGs2)GO TO 15 

K=5 OR K=6 REGION TWO 

NoM+t144 (°K -5)2°7 

Pet JoNEeaN)ICGCC TO 22 

XS=X(K)=ABS OX CK) XC 

RETUR? 

N=N4] 

Pet SoNEeN)GO TO 23 

XS=STEN( Lo oXCK) PE XCK) FX(K) EXC 

RETURN 

N=N41 

IF(JoNEoN) GO TO 24 

XS=SIGN(To es X(K))EXOCK) EX (KDE OCXCKM) ZX OK) DE 820) BXC 

RETURN 

N=N+L 

IF(JoNEON)GG TO i 

XS=K(KM)*FABS (XCK) XC 

RETURN 

IF(KsEQ55)GO TO l2 

K=2 OR K=3 REGION CNE 

N=Mt(K—-2) 57 

ieweermesN)GO TO 25 

XS=X CK BABS (X (CK) XC 

RETURN 

N=N#i 

IF(JoNEoN)IGO TO 26 

KXSH=XCKMIVABSLXCK) PEXC 

RETURN 

N=N+] 

TF(JoNEON) GO TO 1 

XS=SIGN( Lo eX 0K) ) EX (KM PE XC KM IE XC 

RETURN 

Pets PQ>55)G0 TO 13 

K=2 OR K=3 REGION THO 

N=aM+34(K-2)87 

Pet woNeceN) GO TO 27 

XS=SIGN( 1s pXCKM) )EXCK DEX CKD E OX OKI ZX CKM) AXE 

RETURN 

Nh=N4] 

IF(JoNEoN)GO TO 28 

MS=SIGN(1lo sX( KM) PEXCK)EXOK) EXC 
-hh9- 









IFiJdJoNEoN)GO TO 29 
XS=ABS(X(KM) EXC K)EXC 
RETURN 
oO N=N+1 

TF(JoNEON)GO TO 2 
XS=ABS(XCKM) XC KMPEXC 
RETURK 
END 
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SUBROUTINE ABINVIA,AT) 
Sea He As eg ae eee NC e hs oh t hee doa tek ate dab hag dod ott bx pdt eee ey at 
SUBRCUTINE A3INV 


PurmeGSe 
INVERT A GENERAL, NCNSINGULAR 3X3 MATRIX 


USASE 
CALL AZINVCA,ZAT ) 


Deseret!) Gir OF PARAMETERS 
A —- GENERAL,NCNSINGULAR 3X3 MATRIX IN 
Vecren FORM 
fee 1INVERSE OF A 


REMARKS 
P= THE ZERO VALUE FOR THE DETERMINANT HAS 
BEEN ARBITRARILY SET AT 1, 0€-40 
Weer WHLEL BE SEF ZERO FOR SINGUMAR Mei eiCes 


SUBRQUTINES AND FURCTICN SUBPROGRAMS REQUIRED 
NONE 


AUTECR 
MICHAEL No HAYES;RMc5-333,MIT X6807 


= ; i oe s.8 & S o. eee ee 
@y nals as] a5 a 2. Ay - ate xte ° ve 8 he wt -°s ety ats ars “5 “eer is aie 2. 2 3 e at 7 arssrig- ee oi a@*s< Mis ee ee a ee ee oo ~~ S "7 > 
eo SUK ES Be Se oe aes ws 8 Ot wm NT 3 whe ok F528 BeBe foe et Rel oF of. ye ty bye oe olan, Tate HS ee oe oy a = 2 Ge KK 


a. Vt. “wee 


SENS IUN A(1),AI(1) 


morommAi(1H1),*MATRIX A IS SINGULAR, DET(AI=*s El Sc 7; 


#~ 


i! SETTING AI=05 0°) 


CCMPUTE THE DETERMINANT 


ODET=H=A(LI=(CA(5)A(9)-A (6) 2A08) DAZ) CATS I FAT9)~ 
LACS)#@ACTIIVFACZPECAIGISACBI-AU5HI ACT) 


meow DETERMINANT FOR ZERC 
IF{ ABS (DET )—-1-CE-40) 1ls2e2 
mait&(653)CET 
DO 4 1=1,9 
Al(1)=C0:0 
CONTINUE 
Ra TURK 

MATRIX NONSINGULAR, COMPUTE INVERSE 
DET=1-./C0ET 
AI(1LI= (A(5)#A(9)-A(6)4A(83 )¥# DET 
AI(2)=—-(A(2)#A(9)-A(3)A0 8) ) SDET 
AI(3)= (A(2)#A(6)-A(3)4A(5) )8 DET 
ALL 4) =—-(A(G)@A( 9) H-A(6)2A(07) D8DET 
AL(5)= (A(1)#A(S)-A(3)4A(07) }* DET 
A1(6)=-(A(1)2A(6)—-A (3) 8A (4) )4DET 
AL(TI= (A(4)%ACBIH-AC5S DEAT) DET 
AL(8)=—-(ACLIFAB8)—-A(2 8 A07) 8 DET 
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= (AC1)#A(5)-A(2)8A(4) JRDET 





= Nisa 








APPENDIX A9 





CHAPTER DS SUBROUTINES (FIFFECTOR GRADIENT 
SUBROUTINE SHDER(P, MaXs Us hs NS,NL,ND, NDLy NDD,. XSD, Kiet) 


. Se sh Weasels fe deci hesie Meher Ad ee. ee ae AA echo ks de dee S ae apa. sp vy we as Bap! 
C SU3SRIUTINE SnHDER 

C 

C PLRPOSE 

C TO COMPUTE THE STATE DERIVATIVES OF THE SHRCUD FURCES 

C AND MCMENTS FOR THE DSRV 

C 

C SUBROUTINES REQUIRED 

€ UTCC%;ASDER;RGCCM,A3INV,GNPRD 

C 

meOESCRIPTICN 

9 CHAPTER D&yMoNc HAYES THESIS »MIT,197Ly;NAME DEPARTMENT 

C 

Co me £902 Rope pa Mea SRO Re NID BD ain ay ee Sikigagie dt oR ey 


DIMENSION PCL) 9X4) gU(1) 9 XSD(1)5,L (1) 

: DIMENSICN A(18),ASC(18),A1(9),UT(2),FU(3) 
DIMENSICN DAS{(6}),DFUU(6),DFUV(6),DFUW (6) 
DIMENSION DVNS(6)sDWNS(6) yDVTS(6) ,DWTS(6) ,DUTS{( 6) 
Met OKGe Lic 2)>ANDO(L(1)0€Q04))G0 TO } 
XSHR=P (M447) 

CALL UTCOM(U,N,XSHR;A) 
RAD=5702557795 
C GMECULATE U2S(1) 
VSQ=0.5 
DO 2 1=t;3 
UT(1)=Co 
DO 3 K=1,KB 
J=L(K) 
MN=I 4224-3 
UTCII=UTCILIFA(MNDEX(S) 
3 CONTINUE 
VSQ=VSQtUT(I}4UT(T) 
2 CONTINUE 
C CALCULATE SHRCUD ANGLE ALPHA-S 
EPS=P(M+50) 
V=SCRT(VSQ) 
OCALL ASDER(UT; AS; 19 EPS2A2CASy VNSQaWNS QoVVAS sWVNS 5 VNS y 
LDVNS;OUTS;OVTS,;DWTS) 
LF(ASo Lc Oo) AS=AS 43014159265 


AS=AS*RAD 
C COMPUTE LIFT AND CRAG COEFFICIENTS 
4 AND DERIVATIVES 


CALL RGCOM(MsNL»P;IND:AS;CL) 
MNHEM4+32NL+]) 
CALL RGCOM(MN;sND,P,INO;AS;CD) 
MN=EMN43°ND+6 
CALL RECOM(MN,NDL;,PyINDsASs DCL) 
MN=MN4+32NDL+1 
CALL RGCCM(“4N;NDD:P,IND,AS;0CD) 
C COMPUTE VLIFT AND VDRAG : 
BV=09 5%P (M449) =P (M448) 
B=BV*®VSQ 
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VLIFT=8°=CL 

VORAG=B8"CD 

OeMmeere VNEF AND FU(1) 

AS=AS/RAD 

CAS=COS(AS) 

SAS=SINCAS) 
VNFHVLIFT*CAS+VDRAG? SAS 
FU(LI=VLIFT2*:SAS-VCRAG"CAS 

BEGIN COMPUTATION OF DFUU,DFUV,DFUY 
CO 6 K=1;6 

AA=BtFCCL#¥CAS(K) 

AB=B*CDCD*DAS(K) 

AC=2204(UT(1 )=-DUTS (K) 4UT(C2)¢DVTS (K)4UT( 3) DWT SOCK) } 
DVL=AAtBVECL#AC 

DYD=ABtBVeCD=AC 
DNF=DVL*=CAS+OVDY¥SAS-FUCL)SEAS(K) 
DFUU(K} =DVL*=SAS-DVDCASt+VNESDAS (K) 
DVVNS=DVTS(K) /VNS-VNSQ#DVAS(K) 
OWVNS=DWTS (CK) /VNS-WNSQ=DVNS(K) 

DFUV (K)=-DNF# VVNS- VNF“=OVVNS 

DFUY (CK J=-DNFSWVNS-VNFYDWVNS 
CONTINUE 

CALCULATE INVERSE OF TRANSFORMATION MATRIX 
CALL AZBINVIA; AT) 

PLACE SHROUD CERIVATIVES INTO A-MATRIX 
J=1 

DQ 312 K=1-6 

ACJ)=DFEUU(K) 

A(J#1 )=DFUVIK ) 

A(J*+2)=OFUW(K) 

J=Jt3 

CONTINUE 

TRANSFORM DERIVATIVES TG VEHICLE CCORDINATES 
CALL GMPRD(AI,A,ASO2323;6) 

SELECT AND FILL APPROPRIATE POSITIGNS IN XSD(36) 
DJ 13 1=1,KB 

IM=L(1) 

DD 14 J=1,KB 

JM=EL0G) 

POA= IMS ( JM-1} 

I] JX=1646"(JM-1) 

IF(IMNsGTs3!GO TO 15 
XSCCTIJXI=ASD(IJA) 

GO TC 14 

IFC IMCEQ,4)G0 TO 16 

IF(CIMS;E@Q05)GOQ TO 17 

IFC IMs EQ.6)GO TO 18 

XSDCISX)=00 

GUO TO 14 

IJW=35 JM 

MSD{(TIX)J=XSHRZASOCIUW) 

GJ T0 14 

J JW=3% JM-1 


sly Spe 





-455~ 





oe 14 


- 





OSUBROUTINE ASDERCUTsASs IT, EsAM OA VQstlQsVS,WS; VNyDVN, 


SUBROUTINE ASDER 


PURPOSE 
TO COMPUTE THE DERIVATIVE GF DSRV SHRGUC ANGLE ALPHA-S 





SUBROUTINES REQUIRED 
NCNE 


CESCRIPTION 
See SUBROUTINE SHDER 
Smart eR DS6;MoNosHAYES THESIS sMIT,LOT1L»sNAME DEPARTMENT 


eH) SIE Be dee hs tel pay Se etocre  a ye St aK EEN Mh ye ea pe el eae dee ee oy pepe 
Peo tyDVIyDWT) 

DIMENSICN UT(1);AM(1),DA(1),0VN(1i),DVT(1),0WT(1),DUT(1) 

1=0 

VN=SQRTC(UT (2 )*UT(2)4UT(3)8UT(3)) 

IF (VN->EQs 00) VN=1. OE-O8"E 

VS=LT(2)/VN 

VQ=VS/VN 

KS=UT(3)/VN 

WQ=WS/VN 

TFLUT(L)0 EQo05)UT (LIFE 

VUT=H=VN/UT(1) 

VUTS=VUT/UT(1) 

AS=ATANIVUT) 

SVN=SQRTCVN) 

D3 1 I=1;6 

OWT CI )=AamM(321-2) 

aT (1 P=AM! 261-1) 

DwT{1)=AM(3*3) 

DVN{I)=(UT(2)*DVT( I) +UT(3)20WT(I))7SVN 

DAC I)=(DVN(1)/UT(L)-VUTS“DUTC I) )/(1-0+VUT*VUT ) 
m CoN! IMUE 

RETURN 

END 





VAM AAOANANAANANRNAAN 


eee PRDER(P » ak Baie oe . 


mH RR RE RR he Melts seeks eh iy ges ho Ac dt day god dnp gel ectdt bol bode etd #. 
SUBROUTINE PRDER 
PLRPOSE 
TO COMPUTE THE STATE DERIVATIVES OF THE PROPELLOR FORCES 
AND MOMENTS FOR THE DSRV 
SUBROUTINES REQUIRED ' 
NGNE 
CESCRIPTION 
CHAPTER D&,MoNo HAYES THESIS »MIT)1971 » NAME DEPARTHENT 
ee, We octig we. 78 dP yess: Fe te ae oa: Se sen he deg ap A: OK Fe 5 oe: Neat it om aes eae we eh ee i ee 


LOGICAL AyByC 

MPRMENSTON FC2),X(1),U01) 
EPS=1.0E-08 

PM=F (K+36) 
VP=X(2)4+PHAX(6) 

MP =X03)—-PM*X (5) 


OGO TO (1229394 ,5769758999109149125,13,14515,16917,18, 
119, 20,213229233924,2532652 1528229330531) 329337 34535, 
235) 5K 


L 


yy. 


A=X(1)0GE0 05 

B=U(N)>GE> 05 

Geng UtNI—PIM+S5)"X1(1))2.GCEs 00 
IFC AcANDOC}ISW=h 

IF (Ag AKDo so NOT SC) ISWH2 

IF (oNOTo Ao AND. B) ISW=3 

IF (oNOT. (CASOROB) ID TSW=4 
MV=HMt3" CISW-L)AL 

Myl=MV41 

XP=P(MV)*U(N) #20%P(MW)XO1) 
Be TURN 

XP=Oo6 

RETURN 

XP=0o 

RETURN 

A=X(1)0GE 300 

B=U(N) oGEo 02 

C=(U(N)I~P (M435) 2X01) )0GEo Oo 
IFC As AND2C)ISW=l 

TF(AoANDs oNOToOC)ISW=2 

IF (oNCTo AD ANDe B) ISW=3 

IF CoNOTo (As ORd B) J TSw=4 
MV=M43201SW-1L)417 

VW=MV+) 
XP=P(MV}=UCN) 420 #P(MW)EX(1) 
RETURN 

XP=0o0 

RETURN 

XP=O05 





al 


Be 


13 


14 


17 


13 


9 


RETURN 
XP=VPFP(H4+32)20(N) 
VW=SORTOI VPS VP4+WP WO ) 
IF (VWs EQo Oo JVW=EPS 
XP=XP/VW 
RETURN 
ISh=12 
A=X(1)0GE. 0. 
IF(oNCToA)ISW=I SW] 
XP=P(M+tISW IUCN) 
Bae TURN 
XP=Co 
RETURN 
XP=P(M43B3)° UCN) EVP 
VH=SQRT(VP eV PEWP EYP ) 
TF (VWo EQo00 JVW=EPS 
XP=XP/V\Ki 
RETURN 
XP=0o6 
RETURN 
ISW=30 
B=U(N) oGE5 0c 
TF(oNOTOB)ISW=I SWtl 
XP=P(M+ISW)=U(N) 
RETURN 
XP=WP*P(M+232)2U(N) 
Ve=SQRTIVPEVPTHP EWP ) 
IF (VWoEQ0 0c) Vin=EPS 
XP=XP/VW 
RETURN 
XP=0o 
RceTURN 
ISW=14 
A=X{(1).GEs00 
IF (oNOTO A) USW=ISWtlL 
XP=PCM+tISWI*UCN) 
RETURN 
XP=PF(M4+33) *#U(N)-4WP 
VW=SQRT(VP*VP4HP* WP ) 
IF (VWo EQo Oo )VW=EPS 
XP=XP/V¥ 
RETURN 
ISW=28 
B=U(N)oGE002 
IF(oNOToBIISW=ISWt1 
XP=P(HFISWIUCN) 
RETURN 
XP=05 
RETURN 
XP=O0o 
RETURN 
XP=O0> 
RETURN 
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L XP=05 

RETURN 
; XP=0, 
RETURN 
XP=03 
RETURN 
XP=0. 
RETURK 
XP=-P (M4+36) WP P (M432 )42U0U(N) 
VW=SQRT(VP4VP4WP HP ) 
TF CVWo EQo 00) VN=EPS 
XP=XP/ Vik 
RETURN 
XP =04 
RETURN 
TSW=14 
A=X(1)0GEs0. 
IF{oNGTO A) ISW=ISWHl 
XP=-PCMt1SW IUCN) *P (M+4+36) 
RETURN 
XP=-P(M4+33)2U(N )2WPEP(M+3E) 
VN=SORT(VPEVP4+WPWP ) 
TF (Vilo EQo Oo ) VW=EPS 
XP=XP/V¥ 
RETURN 
ISW=28 
B=U{N). GE» 0: 
TF({oNCTZB)ISHW=ISW+1 
XP==P(M+1ISWI2UCN)SPUHM4+35) 
Re TURN 
XP=Co 
RETURN 
XP= P(M4+36 )SVPTP(M4+32 )2U(N) 
Vai=SORT(IVP*VP+WP@WP ) 
IF (VWe EQ005 )VWEEPS 
XP=XP/VW 
Pee PWRN 
ISW=12 
A=X(1).GE> 05 
IF(oNOTS AV ISWH=iSWerl 
XP=E(MtISWISUIN) @PUM430) 
RETURN 
XP=Q. 
RETURN 
XP= P(M4+33) SU(N )#VPFP(MN+3C) 
VW=SQRT(VPEVP4AHPEWP ) 
TF(VWoEQo O02) VW=EPS 
XP=XP/ Vi 
RETURN 
XP=05 
RETURN 
I Sii=30 
B=U{(N).GE5 O- 





(FC oNOTSB)ISW=1ISWtL 
= P(MFISWIEUCN}#PUM436) 
TURN 
7 
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| SUBROUTINE THDER(PsM,UsNgXsXT 4K) 
PR amber oe ee RE eg RE he ah gb edits eee: ete ela oz aba et aa drop ah eae a 


SUBROUTINE THDER oe = 






PLRPOSE 
TO COMPUTE THE STATE DERIVATIVES OF THE THRUSTER FORCES 
AND MCMENTS FOR THE OSRV 


SUBROUTINES REQUIRED 
RGCOM 


DESCRIPTICGN 
CHAPTER D6,MoN>HAYES THESISsMI1T,;1971,NAME DEPARTMENT 


Be fe esse eee Be ak Sst a eS ha a NS OE osc Ro ee tg as oe Be oe Fak ed ep 
DIMENSION P(C1),UCLT) NOL), X01) 
IF {(KeGT.6)¢60 TC 2) 

GO TO (1,323:33435,6) 5K 
21 XT=O05 
RETURN 

1 XT=00 
I=N(2)-1 : 
NT=N(1) 
JS=10 
JR=-1 
MV=M4+207 
DI ¢ JS=UeNT 
$S5=JS+JR 
ITJ=1I+J 
ST=IS+t2 
MV=MVEJIR=1LE 
UVI=ABS(U(IJ)) 
Peawls6Q,03;)GO TO 16 
A=X(1)/UI 
PV=P(M+128) 
IF(AsGTsPV)A=PV 
PW=P (M4127) 
IFCAoLToPW)IA=PW 
CALL RGCGM(MVsN(JT)sP2ITRyAy, TS) 
Mak THABSTUCIJS) ) FES 

16 JR=-JR 

fee@GNe INUE 
RETURK 

2 XT=O0o 
I=N(2)-1 


MV=M4129 
PV=P(M4#128} 
PW=P(M+4+127) 
12 [=I+1] 
UI=ABS(U(I1)) 
IF(UI-6EQ,0.)G0 TO li 
ANS 


ass (2) fa 
LT OL 09(°O 702 [9) 4m 
(CTINYSEV=IN 
tt+l=] a 
{ LZT+W ) d=Md 
{@ct+tW) d=Ad 
62 TtHW=AW 
6=1F 
O=KSI 
T-{2jN=I 
SO=1X 2 
NYNLSAY 
JANTINSGID L 
VP-=UF ST 
Sle( (f LINIVS SV ix ie 
(SLéy Sur edi (LOIN AW) RODD Geis 
Md=VENd7LISV)SI 
(22T+Hd) d=Md 
Ad=VlAd°L9"¥ jae 
(8Z2T4+W)d=Ad 
IN/ (1) X=V 
9T OL G9 °O SO °Ihiee 
((fFTINISAV=IN 
9THUCtAN=Ad 
e+Sf=l1f 
: C+I=f 1 
io ur +Sf=Se 
IN*{t=f @ Gt 
LOZ4+WN=AW 
T-=or 
Oot=Sf 
(TYN=LN 
‘ T-(C)N=I 
°O= 1K 
NYNLad 
“o= 1X 
YA E9ts yf Ete hT) Oise 
TZ OL O9(9°1L9" Ae 
(TYX*S (TINS CT INS CT )d Ol Shae 


y 4 ~ f - «fe : 2s o i? tee oh +o + "0 oe - ewe e+ 6 . Se eS «hee bd] S eee =e SaaS . Boe ow ete - Se ee %. e . eT 
GSU hee RF Meat eis Spd eee RN eas Rieskrkvehik RS dbo k Meee Pes Res OR Se 







INAWLYUVddIG JWVNS TLOTILIRSSISSHL SSAVHSNSWS9G YSLdVHO 
NOTId I YuISSe@ 


WODD8 
Q2yINDAY SSANILNOYEWS 


AYSG SHL YOd SINSWOW CNV 
SSIVOF YALSNYHL SHE dO SAATLVATYSG 3LVLS 3HL 31NdWOD OL 


jJSOduild 


YSQHL JANILANCdERS 
pve wees tay AC Roe vie qe deck yest idk dt teak tok Sook A atc ee dea he Skee eg RE 


(HE LX*X NEN SWEd PYSGHL IJNTINOYGNS 


| SUBROUTINE THDER(PsM,UsNgXsXT 4K) 
PR amber oe ee RE eg RE he ah gb edits eee: ete ela oz aba et aa drop ah eae a 


SUBROUTINE THDER oe = 






PLRPOSE 
TO COMPUTE THE STATE DERIVATIVES OF THE THRUSTER FORCES 
AND MCMENTS FOR THE OSRV 


SUBROUTINES REQUIRED 
RGCOM 


DESCRIPTICGN 
CHAPTER D6,MoN>HAYES THESISsMI1T,;1971,NAME DEPARTMENT 


Be fe esse eee Be ak Sst a eS ha a NS OE osc Ro ee tg as oe Be oe Fak ed ep 
DIMENSION P(C1),UCLT) NOL), X01) 
IF {(KeGT.6)¢60 TC 2) 

GO TO (1,323:33435,6) 5K 
21 XT=O05 
RETURN 

1 XT=00 
I=N(2)-1 : 
NT=N(1) 
JS=10 
JR=-1 
MV=M4+207 
DI ¢ JS=UeNT 
$S5=JS+JR 
ITJ=1I+J 
ST=IS+t2 
MV=MVEJIR=1LE 
UVI=ABS(U(IJ)) 
Peawls6Q,03;)GO TO 16 
A=X(1)/UI 
PV=P(M+128) 
IF(AsGTsPV)A=PV 
PW=P (M4127) 
IFCAoLToPW)IA=PW 
CALL RGCGM(MVsN(JT)sP2ITRyAy, TS) 
Mak THABSTUCIJS) ) FES 

16 JR=-JR 

fee@GNe INUE 
RETURK 

2 XT=O0o 
I=N(2)-1 


MV=M4129 
PV=P(M4#128} 
PW=P(M+4+127) 
12 [=I+1] 
UI=ABS(U(I1)) 
IF(UI-6EQ,0.)G0 TO li 
ANS 





I=N(2)-1 
IS¥v=0 

JT=13 
MV=M4235 
JV=M4123 
PV=P(M+128)} 
PW=P(M4127) 


10 [=I+}. 





UI=ABS(U01)) 
IF(UISEQ400)G0 TO 20 
A=X(1)/ul 

IF (AoGToPV)JA=PV 

TF (AoL To PWIA=PW 

CALL RGCOM(MV,N(CJT);sP,IR5AsTS) 
XT=XTFP(SVISUCT IETS 
MV=MV+3) 

JV=JVt1 

JT=JT+1 

ISW=1SW+1 

Goeto ©b0,;11),1SW 
RETURN 

END 
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MAAANAAIADAINYIAIAIAYANHD 


SUBROUTINE Sa ene NoNPsXP5KyJ) 


aX 3; BRE UN eee We BROT Be ye oh Met ow Rae Seok abs dey ees ps Sewn shs yy. Wate eae os ye ok cat he ae Me OF 
SUBROUTINE PRDEP 
PURPOSE 
TQ COMPUTE THE DERIVATIVES WITH RESPECT TO DSRV 
PROPELLOR PARAMETERS 
SL3SROUTINES REQUIRED 
NONE 
DESCRIPTICK 
CHAPTER DosMoN a HAYES THESIS sMIT,1971 »sNAME DEPARTMENT 
od de ade Sipe a Re ee ee ee Pe th ee a Ce Ue Se OC ee Oe et ee ee ek Ls 
“DIMENSION melee ACL) 2UE) 
LOGICAL A,E&yt 
Be =P(M+36) 
VP=X(2 )4+PM>X (6) 
WP=X(3)-PM*X(5) 
GQ TO (152139%:516)9K 
SURGE REGION DETERMINATION AND EQUATION SELECTICN 
L A=X(1)3GE30; 
B=U(N)0GEo 00 
C=(U(NI~P(M+35)°X(1)).GE0Ce 
IF CAc AND: C) ISW=1 
IFC Ao ANDs WNOTOC)VISW=2 
TFCONOT, A, AND: B)PTSW=3 
TF (oNOTo (Ae GR-B)) ISW=4 
PROPELLOR SURGE EQUATIONS 


NT=M432 
Mme tesNhEsNTIGC TC 21 
XP=UEN)*SQRT (VP=VPtWPUWP ) 
RETURK 

21 GO TG (7,8:9;10),1SW 

tT NT=hM 
MetdolesNl)GO TO 19 
XPSU(N)J=ABS(UI(N)) 
RETURN 

19 NT=M+1 
IF(JoNEONT)IGO TO 20 
XP=X(1)=UCN) 
RETURN 

20 NT=N+2 
IF(JoNEONT)GO TO 22 
XP=HX(LIEXCY) 
RETURN 

22 XP=05 
RETURN 

8 NT=MN+3 
IF(YnNEONT}GO TO 23 
XP=U(NISABS(U(N)) 
RETURN 
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23 


iNQ 
Ui 


25 


10 


23 


1l 


a2 


NT=M4+4 


TFC JoNEoNT?#GO TO 24 


XP=X(LEEUCN) 

RETURN 

NT=Hh+5 

IFC JcNEONT)GO TO 22 
XP=X(LI"X(1) 

RETURN 

NT=Mt6 
IF(JeNEsNT)IGO TO 25 
XP=U(NIEABS(U(N)) 
RETURN 

NT=M4+7 
IF(JoNESDNT)GO TO 26 
RPHKCL IUCN) 

RETURN 

NT=M+8 
IF(JoNEONT)IGO TO 22 
meP=X (1 ex] ) 

RETURN 

NT=M+9 
IF(JeNEoNT)GO TO 27 
XP=U(N)ISABS(U(N)) 
RETURN 

NT=M+10 
IF(JoNEcNT)GO TO 28 
AP=XKX(L IUCN) 

RETURN 

NT=+1) 

IFC JoNEeoNTIGO TO 22 
XP=X(LI°XK(1) 

RETURK 

SWAY REGION DETERMINATICN AND EQUATION SELECT IGN 
IFCUCIN)JoLTc Oo }GO TO 11 
PRUPELLOR SHAY EQUATICNS 
NT=M412 
IF{JoNECNT)GO TO 22 
XP=U(N)=VP 

RETURN 

NT=M413 
ITF(JoNESNTIGO TO 22 
XP=U(N)2VP 

RETURN 

HEAVE REGION CETERMINATION AND EQUATION SELECTION 
IFC UCN )olLT20, 360 TO 12 
NT=M4+14 
IF(JoNEONTIGO TG 22 
XP=U(N DWP 

RETURN 

NT=M4+15 
IF(CJoNEoNT)GO TO 22 
XP=UCN) WP 

RETURN 





di 


30 


eZ 


35 


35 


A=X(1)0GE,02 

B=U(N) oGEo Co 

eae (N)-P(MA+3Z5)"X(1)),.GE5 05 
NT=M+33 

IF( JoNEoNT)IGO TO 29 
XP=UCKNI=SQRTI(VPEVYP4WPAWP ) 
RETURN 


NT=N+34 

IF CJoNEoNT?GO TO 30 
XP=U(N+1) 

RETURN 


IF(Ac AND: oNOT2CIISN=2 
IF(e NOT. ASAND-.B)ISW=3 
TFLoNCTo {Ac OR. B)) ESWH=4 
GO TO (13,14,15;16),1SW 
MewecLLOoR ROLL EQUATIONS 
NT=M416 

TF(JoNEONTIGO TO 31 
XP=UCN)J=ABS(UC(N) ) 
RETURN 

NT=M417 

IF(JoNEONT)IGO TC 32 
XP=X(1)"U(N) 

RETURN 

NT=M+18 

IF(JoNEeNT)GO TO 22 
XP=X(1L)*XC1) 

RETURN 

NT=H419 

MeCJoNEoNT)GO TO 33 
XP=U(NISABSCUN)) 
RETURN 

NT=M44+20 

IF(JoNEoNT;GO TO 34 
XP=X(1)8U08N) 

RETURN 

NT=M+2]) 

IF(JoNEwNT)GG TO 22 
XP=XCLIEX(1) 

RETURN 

NTHH4+22 

IF(JeNESNT)GO TQ 35 
XP=U(N)®ABS(U(N) ) 
RETURN 

NT=hit23 

IF(JoNEONT}GO TO 36 
XP=X(1)=U0N} 

RETURN 

NT=M4+24 

PP(JGNEoNT)GO TO 22 
XP=X(1)2X(1) 

RETURN 


-~W66- 


Fe . oF 








NT=44+25 

IFGSJoNEONT?IGO TO 37 

XP=U(N)*#ABS( UCN) ) 

RETURN 

NT=M+26 

IF(JoNECNT)GO TO 38 

XP=X{1)#U(N) 

RETURN 

NT=M+427 

IF( JoNEONT)GO TC 22 

XP=X(1)2X (1) 

BeETURN 

PITCH REGION CETERMINATION AND EQUATION SELECTICON 
meCuUt( Net 1,05, )GO TC 17 

PROPELLOR PITCH EQUATIONS 

NT=N4+28 

BeiJoNEsNT)GO TQ 22 

XF=UCN )S WP 

RETURN 

NT=4429 

IF(JoNEONTIGO TC 22 

XP=U(N )WP : 
RETURN 

YAW REGION DETERMINATION ANC EQUATION SELECTION 
IF(CUC(NJoLT.0O.)6G0 TO 18 

PROPELLOR YAW EQUATIONS 

NT=H+30 

IF{(Js5NEsNTIGO TO 22 — 
XP=U(K)=VP ‘ 
RETURN 

NT=M431 

IFC JeNEONT)GO TC 22 

XP=U(N}==VP 

RETURK 

END 





RMAADAPIAM|DA NIA A AIAIANIN 


SUBROUTINE THDEP(PsM,UsNyX3XT 9 Ky J) 


ramimrebeeke Geog: 2): hc of asf eesti ike pe sSshadee deck ee ck area Psy Sisk oe Sekt gs hak ahead oboe eat at aye dp th ok 
SUBROUTINE THDEP 
PURFOSE 
TO CUMPUTE THE DERIVATIVES WITH RESPECT TO DSRV THRUSTER 
PARAMETERS 
SUBROUTINES REQUIRED 
RPDER,RGECCH 
DESCRIPTION 
CHAPTER DGsMoNoHAYES TEESIS;MIT;,;1971;NAME DEPARTHENT 
ee Mees a, ae Se BES SPs os Se hE ats Bk LE My Bes eas ky) yh ah hae ah ay eee ee oe, Me 


12 


DIMENSION P(1),UC1) N42 ),X02) 
GO TO (14293343576) 9K 
THRUSTER SURGE EQUATIONS 
XT=O0;3 

I=N(2})-1 

NT=N C1) 

JS=4 

JR=-1 

MV=M+60 

DO 7 J=1,NT 

JS=JISH#IR 

Ro=i+J 

Sh=JISt2 

MV=MV4JIR#10 

e=AoS (UCI JS) ) 
Pe(UlctQs0;)G0 TO 1é 
A=X(1)/UI 

PV=P(MéM+128) 

IF (A£5G6To PV )A=PV 
PW=P(M+]27) 

IFC Aol ToPW)A=Ph 

CALL RPDER(MVyN( JT) Ps IRyArXTsJsL) 
r= UC PeUT J) 
IF(LoNE.O) CO TO 13 
JR=-JSR 

CONTINUE 

ReTURN 

THRUSTER SWAY EQUATIUNS 
XT=O05 

T=N(2)-1 

ISW=0 

w= 3 

MV=M 

PV=P (M4128) 

PH=P(MN4+127) 

T=I[+] 

UI=ABS(UC(I)) 
PeeGleetQ,.0,)G0O TO i? 
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1? 


13 


14 


3 


5 


LS @! 


A=X(1)/UI 


TFCAcGToPV)A=PV 


IF CAsL ToPW)IA=PW 

Meret RPVER(MV,N(JT)sPeIRe Ay XT, JL} 

XT=XTF UCT) ABSCUCT) ) 

MmiloNs&.0)CO TO 13 

MV=HVt25 

JT=JST+1 

ISW=ISWtl 

GU TC (12:13),I1SW 

RETURN 

MmmoesotER HEAVE EQUATICNS 

XT=05 

T=N(2) +1 

ISV=6 

JT=2 

MV=M 

PV=F(M4128) 

PW=P(M+4+127) 

I=J]+1 

UI=ABS(U{I1)) 

IF(CUI-EQ.0.)GO TO 18 

A=X(1)/UI 

TF (Ao GTe PV) A=PV 

IFC AoLToPW)IA=Ph 

CALL RPDER(MV NC JT) »P eT Re Ay XTeJdsLh) 

XTHXTZUCTISABS(U(I)) 

Pr(ioN&,0)C0 TO 13 

MY=MV+425 

JT=JST+1 

ISW=ISW+1 

GO TO (14,15),1SW 

RETURN 

MamuoteER RELL EQUATIONS 

XT=05 

RETURN 

THRUSTER PITCH EQUATICNS 

XT=Ce 

I=N(2) 

JV=M4122 

JF( JoNEoJVIGO TO 21 

XT=UCIT)ABS(UCIT) ) tUCT 4 LIE ABS(UC TAL): 

RETURN 

ISW=0 

T={+1 

MV=M+75 

JT=7 

JV=HM+120 

PV=P(M+128) 

PH=P(Mt127) 

T=I+)}) 

UI=ABS(U(I)) 

fete 6Go05,)1G0 TO 19 
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Ze 


i 


10 


23 


20 


zl 


A=X(1) /Ul 


IF (AoGToPV)A=PV 
IF(AsL To PW) A=PH! 
mee NEoIJVIGO TG 22 
Syme RGCCOM(HMV,N( JT ),P,IR;,A,TS) 
XT=TSZUCT “ABS (UCT)) 
RETURN 
Mee RPDER(MV NC JT) .PsIRsAsXT;5J5L) 
XT=XT UCI) SABS(UCTI) Pe PCV) 
feito NceO}GO TO 13 
MV=MV422 
JVH IVE] 
JT=JT+1 
ISW=1SW+l) 
GS TO (8,9)-I1SW 
ReEfuRh 
THRUSTER YAW EQUATIONS 
XT=Co 
I=N{2)-1 
ISW=0 
MV=M+76 
JT=7 
JV=MNt123 
PV=P(M4128) 
PW=P{(M4+127) 
=I[+] 
UI=ABS(UiT)) 
IFCUIcEQ,0.}G0U TO 20 
A=K(i)/UIJ 
IF(A>GToPV)A=PV 
IFCAoLToPWIA=Ph 
IF(JeoNEeJVIGO TO 23 
CALL RGCOM(MV,N(JT)3P_ IRAs TS) 
XT=TSPUCI)=ABS(U(T)) 
ReTURN 
CALL RPDER(MV NC UT) sPeiRsAgXTs Jel) 
KT=XT#UCTP#ABS( UCT) )#P( JV) 
IF(LSsNE.0)GO TO 13 
MV=MV422 
JV=JVi1 
oF=J1+}) 
TSH=1S\ht1i 
GO TO (10,113),1SW 
T=I1+) 
IF(JoNE.JVIGO TO 13 
XT=UCT )HABS(UCI) ) FUC TFL) FABSCUCT4+1)) 
RETURN 
END 


7 0= 





SUBROUTIHE RPDER(M Ns P,1yX5Y,U5L) 
do Sodke Peo NER i ee gto ee me eheh eS oe ek ee alk, Sree 2, EEE. EM: Se HH eH Kh D 


SLARIUTINE RPDER 


@ 







TO COMPUTE THE PARAMETRIC DERIVATIVES OF A LINEAR VALUE 
WITHIN A RANGE WITH RESPECT TO STRAIGHT LINE SLOPES 
AND INTERCEPTS 


SUBROUTINES REQUIRED 
NGNE 


DESCRIPTICN 
CHAPTER Dé:MoNcHAYES THESIS sMIT;L9O7TL=NAME DEPARTMENT 


Pee Eek 27: of. Sake semi Soy ok et A he BOG. Foe iad Shae sods od ae DM RT ck 
DIMENSION P(1) 
L=0 
DO 1 K=1,N 
IF(X2GToP(MtK))GO TO 1 
T=K 
MV=MNtN+K 
IF(JoNECNTIGO TO 2 
Y=X 
L=} 
RETURN 

2 NT=NT+N 
IF(JoNEoNT)GO TO 3 
Y=lo 
L=2 
RETURN 

3 Y=0o. 
RETURN 

1 CONTINUE 
I=-} 
Y=Qo 
RETURN 
END 
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APPENDIX A10 













HE MEAN OF 4 SQUARIED GAUSSTAN RANDOM VARIABLE 

Given a normally distributed, zero mean random variable x as 
xpressed by equaticn Al0.1, and a general squared transformation as 
in equation Al0.2, the resulting random variable y is shown to be of 


ion-zero mean given in equation A10, 3. 


x = N (0, o%) A10,1 
EI y | = ag? Al0,.3 


The probability density function for x is given by equation A10,4 
and the associated probability density function for y is given by 
equation Al0.5 (P-3, pe 130). The mean of the random variable y is 


expressed by equations Al0.6 Al0.7, and ALO.8. 








x2 
ik ie 
= l 
fa) = ee A1.0, 4 
= 2 
Me 2c “7 Uy) M10. 5 
ofeitay 
U(y) = step function in y 
C - 6 
ElyJ=JS y f(y) ¢ A10. 
Dd 
ve) - v_ 
l= J We 2e0" ay A10.7 


oJfena 





x) #b 
HyJ=kf Woe” ay A10.8 


Where K = Lo 
O.f/2T71a 


{ 


: 
D =e. 
Zag” 


The integral in equation A10.8 may be transformed to the 


integral in equation AL0.10 by using the separaticn of variables in 





equation AlO.9. Equation ALO.10 is a standard definite integral 


(S-28, Integral #531) whose result is given by equation A10,.11, 


f udv = f vdu - uv| A10.9 
Where: u= fy av = oT by dy 
Be 
du = 4y ? y= - Dee 
b 
“by 
fy] = * a — dy A10.10 
ace. ay “/t A10.11 
of yb 


With the substitution of equation Al0.11 into Al10.10 the result is 
directly given by equaticn Al0,3. This then shows that the mean of 
the squ2re of a zero mean gaussian random variable is nct necessarily 
of zero mean. Many of the biases arising in identification processes 
for nonlinear stochastic systems may be partially or wholly attributed 


moe this fact, 


== 





APPENDIX All 


A NONLINEAR OBSERVABILITY CRITERION APPLIED TO SHE DSRV SINGLE DECREH 


eine ie at oe ~ Te Ge. ae 


OF FREEDOM EQUATION 

A nonlinear dynamic system given by equations All,] and All.é is 
observable if S, u(t), and y(t) determine x, uniquely. A sufficiency 
criterion for checking nonlinear system observability is given by 
Schoenwandt (S-5) and is applied here to the DSRV single degree of 
freedom equation All.3. The general nonlinear state estimation problem 


for equation All.3 is given by equations Al1l.4 and All.5. 


x= f (x, wu t) ; me (ea All.1 
y= 8 (x, ws 2) Xo 5 Al1.2 
x = ax* + bu* y = cx a3 
x) Xo x4 + Xs ie 

Xy |= 0 Al1.4 
i, , 

y = [c 0 0] [x Xo x3), All. 5 


Schoenwandt's criterion consists mainly of finding enough initial 
values of y and its derivatives to specify X¢ The following chain 
(Al1.6 - Al1.15) of equations develops the observability criterion 


steps for c = ] in Schoenwandt'ts terminology. Equations Al1.6 through 


. = Al1.7 
Us 0 


atv) = 


«@ * 











By = %o | A11.9 
g as ms F(x Yos to) de] A(t) 
ee), * Ox, * dal, A11.10 
‘@) 0 O 
a 2 2 
g 8 + al ac noe Ou 08) pity) 
2 ae ae Wa,2 
L t u + 
Oo oO 0 
epee 10 “20 2) A11,13 
OE> d8| f(x. ust.) de] a(t.) 
g.=—=— fe one <fo) icoeee ° All .24 
5 dt ax d tart 
t Tt “lt 
O .@) .@) 
—- 9? 3 
6,7 6/6, + 2X BC A11.15 





Al1.15 can now be shown to determine X, uniquely in terms of Gt Bs 


if 
Bos and 8, @s in equations Al11.16 through A11.18, 
Xo * 8 uniquely AV Dggel'6 
_ ee 3 f ; 
Sa (3. Ey g5) yi 26, uniquely; 7 0 All1.17 
Pe a cs ree 2 n* nie) wv: ae ee 
Xa By (2 X59 8) / u’ uniquely; uy # 0 A11.18 


The initial state vector x, is uniquely determined in equations 
Al1.16 through Al1.18 and therefore the nonlinear state estimation 
problem is observable and al] of its states may be estimated. The 
condition g, # 0 imposes a limitation on the initial value of the 


input function given by equation Al1.19. This equation simply says 


aips5= 





the system is not initially at its steady-state value, The 


zs 2a 
u? f - = rs A11.19 





her condition on the input 2. /- QO says that there must be some 
itial non-zero input to the system for observability to be possible. 


is appendix applies to Chapter P2.3. 
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APPENDIX A12 
MODEL REFERENCE SINGLE D8GREE OF FREEDOM PROGRAM AND SUBROUTINES 


PROGRAM FUR NOMLINGAR ICRKUTIFICATICON COST FUACTICN 
Petit NCISE 

REAL M 

Beeeno TCH VEC(47),x%4(47),xV(94) 
fewer ON CL(4/),CNI51),6051T(2397} 
Peretti) P(282) ,)0(5),66(5) 
Corrchk 7 PNYOIS/AA,S 

COMMCN FPO /D 

COHMCW /PMS/G 

AMEN» 

B= 1. 

NCC=2 

NGG=2 

M=4s5U075 

CO7=-lés7 

Wire = 1556 

Wiest =—22 02 

CNST=555, 

DeLCD=0; 25 

DeLCi=10. 

AZ=CCZ/$M 

AZ=CN2Z/H 

C=l, 

peta DST /" 

PST=CNST/M 

GCA=CELCO/H 

Poor LCN/* 

N=47 

Meets DI) (OD(1[:,1=1,5) 
pemet 9 20)(GG()]),1=1, 5) 
meer Al (if! 3.,2 ) 

T1=9.0 

Xl=Ve 


\NCO=47 

ICNHANCN-1 

me U=NCD- 1 

NS=0 

NC=] 

mec? J=CDOST 

wees [=1,1C0 
Pree y=C)( 1) +DELC 
Cem inue 

CN(LI=CNST 
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et 
EO 


fieo JS—-1L,iICNn 
Pee J+ 1 )=CNC 
ei Tee 

CO 10 IDD=1,N 9D 

S=CC( ICD) 

OC Li IGG=1,N5G 

G=G6(1G5) — 

MermeuUre VeCc 

Lt. Ooeetiy 11s XiskKyN,AZ,87,C0,VEC , RAST xy) 
Poet K=1,NPL 

Pen =TItFLOAT(K)-# 

My tKaeNPL Y=aVEC(K} 

Cent ier 

reer COP (UyXV,NPL,2,°)) 


Pete Ch 


Peo £ AND B PAR MAETER VAS LTT Tom AND C351 


Boo | 

ees J lyhliCiN 

A=AST 

eo 2 il=i mac 

Meee ii Ctl, T1, XT y:1,A,830,X™) 
ee es! 

BOsitctic)= 

Pea I SQH=1 41! 

Meee! e THe SQUARE CF TEE ERRCE 
meee VEC { JS" )-— Xr (US 2) 

MC ICV =CUST INC) AXUITF *XxXCIlFe-dH 
em | NUS 

Pee rim AT( I-21 ) 

COMT TANUE 

pero USerLIAT( J-1) 

Ser iNUE 

Orme CENTUR (NU,CD,CN, COST, NCUD,NCK RS) 
meg! SETUP 

OG 7ii=iyNCoO 

Pa l)=CO(T) 

PUnme@e+ 1)=COST(1) 

Meer i )y=COST(LS@NCO+1) 

Pus smeut 1 )=COST(254NCD0+I) 
PX42NCD+4+1)=COST(384NCdDt! ) 
Peewee + 1 =CCST (504hC0eT) 

een rise 

eee itl? (NG, Ps*ICD,é,NS) 
NO=NUti 

CONT IMUE 

CONT TRUc 

oe UP 

ED 
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eee FUNCT [Ol F(T »X;U,A,B6,&) 
NCNLIKEAR ABSOLUTE SQUARE LAW VEFICLE 
COmmed /PNG/G 

F=AYX*ABS(X) +6h-*U2ABS(U)4G6%W 

RE TUR! 

Ef.D 


SUBRO@MTINE RK(H,TT,XI.KyNyA, B,C, VEC, 1X, 1XY) 
Wires loN VEC{ 1) 
COMPCR /PND/D 

X=X] 

T=TI 

foeee il=1,% 

UV=L(T,X) 

WV=E=WC EX) 

VVEVCIXV) 

Rovere tty XeUV,A,8, WV) 
T=T+H 

ieee )=X+D=VV 
CONTINUE 

REWER h 

END 


See SOT INE RKINT(CHs T1yX%14N,4,8,C0,VEC} 
Peeve N STON VEC (1) 

X=X1 

T=TI 

DO 2 T=) ,N 

JIV=U(T,X) 
X=KtH"FUN( T,X ,UV,A,8) 
Tat +H 

wy ECT 1 )=X 

CONTINUE 

RETURN 

END 


REAL FUNCTION FUN( T,X ,UyAsB) 
feeeeeiVEAR ABSOLUTE SQUARE LAW MODEL 
ee Pee ASS (X)+8™U2- ABS CU) 

RETURN 

ENC 
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Geet TNC TION VClXx) 
Meee) NISTRISUTION 
eer 7 PNOIS/AM,S 
et Cra 1X) Sy ht; V} 
RETURN 

END 


Peet UNC LON UCT, x) 

See we ISPLT OF UNIT FEIGHT 
U=1s 

RETURN 

END 


Peet «Fie TON WI ¥-) 
Peete? OISTRIBINTIIN 
COMMON /SPNOTS/AM,S 
CALL GAUSSCUETXyS,AMyW) 
RETURN 

END 





Additional Subroutines: 


GAUSS, RANDU Appendix A4 
CONTUR, FLOT Appendix A5 
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APPENDIX A13 











(ODEL REPERENC# STUDIES OF A LINWAR SURGE EQUATION 

Many of the studies conducted in Chapter P3 for the nonlinear 
DSRV surge equation were also conducted upon the linear equation 
Al3.1. Many of the same inputs were used and most of the results are 


presented here in the same form as in Chapter P3, The inputs used in 
4507 x = -100x + 755 u Al 3.1 


these studies are the step, staircase, simulated impulse and sinu- 
soidal with 150 second~period. A listing of the applicable tables 
and figures is given in Table Al3.1. The inputs correspond to those 


in Chapter P3, 


Contours Noise Behavior 


Step Figure Al3.1 Table A13.2 


Staircase Figure Al13.2 Table Al3,3 
Impulse Figure A13.3 Table Al13.4 


Sinusoidal-150} Figure A13.4 Table A13.5 
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Table AL3.2 NOISE CHARACTERISTICS ,LINEAR SYSTEM, STEP INtuT 
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Table A13.4 NOISE CHARACTERISTICS, LINEAR SYSTEM, 


Se ie ences ee 


SIMULATED IMPULSE INPUT 
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v-0, w=0 


V=0, w=]. 0% 
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Table A13.5 NOISE CHARACTERISTICS, LINEAR SYSTEM, 
SINUSOIDAL 150 INPUT 





Additional studies were made using the linear vehicle in equation 
Al13.1 and a nonlinear absolute square model to simulate the fitting 
of a nonlinear model to linear cata. The contours of these runs using 
a sinusoidal 150 second~period input are shown in Figure Al3,.5 and 
show that the best nonlinear fit for equation Al3.1 is given by 
equation Al3.2, The noise characteristics of the nonlinear model for 


linear data are presented in Table A13.6. 


4507 x = -19.7 x |x| + 645 u [ul A1L3.2 
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The contours and tables in this appendix show that the sinu- 
soidal input function is the best of those inputs tested for identi- 
mreation using model reference contouring. In addition, tne noise 
characteristics indicate that the 10% v and w noises generally 


permit about 5% varaneter identifications. 
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Figure Al3.3 LINEAR SYSTEM 
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Figure Al13.4 LINEAR SYSTEN, NO NOISE, SINUSOIDAL 150 SECOND INPUT CONTOURS 
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APPENDIX A14 


Par PY KF SINGLE DSGRSE OF FREEDOM PROGKAM AND SUBROUTINES 

PROGRAM FOR KALMAN FILTER STUDIES IN A SINGLE DEGREE 
OF FREE DO WITH ONE STATE AND THG PARAMETERS 
REAL ™ 
DIMENSION Z25(728),US(188),TS(288)eXVEIGL) 
DIMENSION A(9),F(3) oXHT(3) 4 X¥BAR(3),H703) 
DIMENSTON EHT(S) ER AR(S),EGAIN(3) 
DIMENSION XPL(2745) 4 APL( 376) »PPL (376) 
DIMENSI GN €PX(276),EPA(276) ,—&PB (376) ,FPL(13215) 
COMMON /RKT SD 
COMMON /PEE/G 
COMMON /UFUN/HVs TP» TPP, TO 
COMMON /HOYSE/AN,S 
Bowwe 7STOR /PY DA »DB. DEX, DEAL DFR. TSC 
NDN = 
1XV=2 
TXWwetrg2 

am a ty? 


eS Fi NC=1 . NON 
G=90.9007 7 

Oe > ©GMO=) ,NDY 
HV=0.5 

Te=) 00.2 

fer =200. 

TO=0. 

AM=O, 

S=5. 

M=4507.0 

EM= t 

DY=1. 

DAS 1./EM 
pR=1./0™ 

DEX=7. 

DEK aL. / (FEM 
eo 7. / { Sie £11) 
M)7=-iC.7 

ez = 755,94 
AZ=CO7/%4 
B2-Ch7/ 4 

T1=90. 

XT=0. 

C=". 

N=" BE 

H=2.5 

Ns —*. 

SC=0. 

GENERATE INITIAL VEHICLE DATA WITH NOISE 
CALL PKNLOH,TIeXTeN ep AZs B24C ZS wll Se T SURRB SR? 
Sere ityytAL DATA 
USC=0. 

NPL =47 

KS=4 

Mo } 8=i2-NPL 
L=KS*K 
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mye Kd=T S(t) / TSC 
RVUNOL EK IRUS(L)4FUSC 
Pvt se *NPL+K ) =ZS(01.)4+S8C 
PeCONT INGE 
Met PL OT(0.,XV,NPL. 3.0) 
mer bret SETUP 
epee AN SILTER INCREMENT,STARTING INDEX, 
PrP STOPPING INDEX 
KST=1 
KFINC=} 
Poe Rol tr KFEINC 
KFINS1T68 
Sees) STAI STARTING STATE ESTIMATE 
toe l=i. 
meia—-ii ,2/h 
gay =f. 5 ../™ 
SET XHAT(0) 
peat = XST 
bay (2)= AST 
Ain? ( 4)= 8ST 
Beer GGOEPATED NOTSc PARAMETERS 
Pyl=i. 
MW=2. 
SET HOUSE PARAMETERS, Q FOR VEHICLE NOISE #, 
fee me Par MEASUREMENT NOISE V 
P=P Wel) * D Note: P= R used in Chapter Pl 
Q=QW"G* G 
meets et TZ UAB AMC EHAT MATRICES 
bee ¥=72.°¢ 
Atk )=0. 
ear ty)=0. 
BeCON TINUE 
mee )=0, 
er 3)=C. 
SET INITIAL ERFRR COVARIANCES 
Pe7{\)=0.° 
mts ae). / ( MaeM } 
ere = 2500 ./ (Vx) 
DEFITE Hi MATPIX 
eC I4=C. 
Wyte )=0. 
wisi. 
PLACE INITIAL VALUES Th OUTPUT 
NP=3 
09 3 K=1,NP 
USV=USi(1) 
W791 gX1) 
US(1)=U2Z 
Ot—H 
CALL PROP(OT.US, Calhe ri es 0 a XBAR , Ele | ) 
CALL GA IN( EBARGHZeP eEGAIN) 
CALL UPDAT( ZS,HZ, ER ARs X BAR, EGATNYXHT rEH Ts 3) 
OGRE STSRE( XHT.EHT. TSsXPL+APLs RPL,JEPL»eEPX,EPASEPBsil, 


OL 








JKFIN) 
MSGS P= USV 
BEGIN ITERATIONS FCR FILTERING 
ee 4 T1=KB.KFIN 
NV=I!-1 
DT=TS(IT)-TS(NV) 
PROPAGATE THE STATE AND ERROR COVAP TANCE MATRIX USING 
THE NONLINEAR VONEL AND AN EULER INTEGRATION 
METHOD FOR INCREMENT OF TIME DT 
CALL PROP (DT,US, XHT sEHT oA4 9 XRARVERAR, II) 
COMPUTE THE KALMAN GAIN MATRIX 
Peete Gay INC: CAR,tHZ,P,EGAIN) 
UPDATE THE STATE AND ERROR COVARIANCE “ATP1X BASEN 
UPUN MOST RECENT MEASUREMENT 
GW UP DAT( 25,172.68 AK, X RAR, EGAIN,XH™ EHTGEI ) 
STORE THESE VALUES CF XHAT ANC EHAT FO? LATER USE 
AND FOR PLOTTING 
OCALL STORECXHT,EHT, TSsXPLeAPL» RPL EPL»EPX,EPAVE NGI, 
LKFIN) 
& CONTINUE 
PLET CUTPUT FUNCTICNS 
CALL CUTPIXPLIAPL» RPL PLE PX, EPA, EPSIK FIN) ; 
3 CONTINUS 
G=0.017 
6 CONTINUS 
D=0.7? 
5 CONTINUE 
SU 
END 
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SUBROUTINE RKNL (ty T1aX 1 oMy A782 9Cs2 SoUS oTSy XW y EXV) 
MST ON 7 S(1},0S01),7TS¢1} 

PCOMMO@N /RK1/D 

X=X I 

T=T I 

A=A7 

R=R Z 

VYV=U(T, X} 

WV=W( TX W) 

me 62 J I =] aN 

eet t IyX, UV,o,R WV) 
M=X +77 

T=7 +H 

Moisi i}j=* 

UV=U'CT, X) 

US( TI) =UV 

VV=EV{IXV} 

7=C% XD *VV 

moth 1j=7 

CONTINUE 

Pe 1 UPN 

END 
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Beal PUNCTIGN FCT sX UrA Be} 

ROM MAR ABSCLUTE SQUARE LAW VEHICLE 
Cer son /REF/G 

FAs %? BSCX )4BX UAB SU) 4Gu' 

RETUPS 


ly Ql. 


— 





eee WCTION U(Ts%) 
BPAPRCASE WITH 2 STEPS 
COMMIN /UFUR/H,TP,T PP,TQ 
mee t--3P)1.? me 


my U=H 


RETURN 





feet ITP P) 3, 454 


3 U=2.%H 
RETURN 





RETUPH 
END 
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Seeeoer THe PROP CHSUS +s XHT+EMT<A, OeXBARGE BAP, 1) 
‘DEWEMSTOMN US(L) » XHT C2), FHT 04) A071), XBAR (1), EBAP (2) 
oa meme YON rte). £209), F3(5) .£E64(9),F5(9) 

R= XHT(? ) 

me 3 J=',° 

Pee J)=ERT(S) 

COM TINUE 

UV=USCT ) 

TI=HHZFUNTCXHT,UV) 

freee UNIT A,EHT LO, 61 XHTUV ) 

RRAR(1)=xX+T 1 

XBAR (2) =XHT (2) 

Peay. (2) =XHT (2) 

fa Jyh es 

Bere (OW = 2S ( JIE 2 (I) +H 

SOR Trthusc 

me? USN 

END 
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Sere EFUMGA,E «0,EB.X, U) 

See WON Ath). E (4 oe EFROA),X% (3) 
Biles “XT? YWARS (X(1)) 

mee p-KC LS )*ABS(X(3)) 

AC7 )=U* ABS ( U) 

FB( i )=2 -4(A CL) *E (1) #404 7%E (2)4A07) E03) 40 
OER( 2)=F (27 (ACE) +A01)) #A02) ECL) FA0 8 KE (3) + 
Mert (5) +2 (7)*0(6) 

meee — (2)* (A(1) +A(F)) A038) E01 4416 *E(2)4 
LACG EC GVAA CTI*E CS) 

Opi 4)=€RB(2) 

Poa 2 wr (A L7)*E (2) FACE DE 
Metron fF (6) =f ALS ) +A 9) 94402) 
meee (3) +A (8) (9) 

EB(7)=£ 5(3) 

Sao re. SE } 

EBC9 =e o*X(A (33% E13) 4A06 DEE C EDFA (9) E(9F ) 
RETURN 

END 


)+ ae: Cins) 
Plc lah) wees 


f 
we 
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PAL FUNCTION FUNL(X,U) 


SKC 2X (LIX ABSOX(L) PAX C3)*US ABS CU) 
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DUT INE GAINCE: HPs EG) 
were le EC CTP, CG) SEG CL) 
C=H(L)#HED ) #EC7) 4P 
eee C1 XE (1) /7C 
feet (')* (2) /C 
Meee te E (2) /C 

R eT Ue N 
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SeeROUT ING UPDAT(2,H,ER,XR. EG: XH-FH, 1) 

De} Ja t03 

meet JB PcG 0 201) -102 ee XB()) 

Gents 

pee bye B01) (1. -EGC 2d eH(7)) 
f= (2) -EG( 2) * (3S PEER CT 
me 3 JE 8(3)-EG03 eR (SEB) 
EH(4)=CH(2) | 

emer (> ) - EGC 2 Pet! (2) es EBC 2 ) 
orn (C) -CG( 2) SHI) * ERC 2) 
eel 7? )=EH{ 2) 

BHC S)=EH(46) 

em ep 09} ~SGt 7 HK (7) 083) 
RETURN 

END 


) 
) 
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Sere T INE STCREL (XH, Et, T2XP AP, BP,EP EX EA, ED; I gh) 
Seer LON Xs FRCL) s TOL), XPC1) APC 1), ROCT PHEP (LYS 
DEXC Let AC(1) EBC? ) 

Cores /STOR /0%.0A,0B,DEX,DEA, DER.C 

D=T(TI/C 


ty ee) A es | 


DU a es 


N=} +k 

XP(N)=XHC4t) /9X 
APIN)J=KHC2) /DA 
BP(N)=XH(217 /C6 

eevee oe) CABSCEH(1 )/DEX)) 
Prouriy=5 ORT { ASS(EH(5)/OEA)) 
Punig= > CRI ( ABS{(EH(9 )/DEB)) 
RETURN 

END 
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SUBROUTINE OUTPOXP, AP YBPSEP EX, EA, EB,K) 
DIMENSTON XP(1), APC 3). BPC LD EPC LDSEXCL) 2EAC LIVERY) 
KVf= K 

K=4 7 

[=64 

NO 1 2 4K 

IL= Yb 

eee LS KP) 

BPC T)=HAPC(IL) 

BPI TJ=PP(I1 ) 

Bret i P=EXUIL ) 

Pre T= BACT!) 

Beter p= S( TL ) 

CO Maleate! & 

Oo 2 Y=",K 

[v= T+4 

KP=KV+T tL 

RPM T= XP KP) 

pet Tir) = APL K®™ ) 

BP( IKI =8P(KP) 

ext IK)==EX(K"™) 

mere) = SACK P) 

Brae tK)="R(« P} 

CONTE S 

NS=0 

Nai 

M=2 

CALL PLGOT{(N,X2,K My, NS) 

N=N+7 

ret. PEGT(N «AP, Kee NS) 

A= N +7 

CALL PLST(N «BP, K eM, NS) 

N=N +2 

CALL PLOT(N »EX+KeM, NS) 

Nai +2 

ert PL GY (te CA. Kh, NS) 

nit 3 

Ceipl PLOTIN, ER, %oM, NS) 

K=KV 

KPa 2% 

MPITE(4 TO) APCEP),EATKE) BP (KP) FERC KP) 
BOPOMMAY (RHO. Xs" AB's 2XeF 14.728 a CR hpi 
Mp eehe Oke tt4ey,!' + OR — ' fl 4.7) 
RETURN 

END 





Additional. Subroutines: 
GAUSS, RANDU - Appendix A4 
V, W ~ Appendix Al2 


PLOT ~ Appendix A5 
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APPENDIX ALS 


PUTTING A “WHAMMY ON NEGAUTVe FON EXTENDeD KALMAN FILTERING 
The B matrix in the propagation equation Al5.1 for an extended 


Kalman filter should never become negative for a positive definite Q 


Be Pe-+ gel +Q 5.1 


matrix. However, in many of the nonlinear ocean vehicle simulations 
the E matrix approaches zero very rapidly, and either computer noise 
or system noise may cause it to become slightly negative, especially 
for large integrator time steps. Equation Al5.J). usually becomes 
completely unstable for negative E; and unless some provisions are 
made to correct the situation, the entire Kalman filtez> run will be 
program interrupted out of the computer due to exponential overflows, 

The following Fortran statement A15.2 has been used by the author 
on several occesions and has saved quite 2 few kalman filter runs 


which would have otherwise "blown up." The use of this simple, fast, 
IF (K.LT. 0.) Ee -E 3 E= element of E matrix AL5.2 


and definite correction technique is almost devoid of theoretical 
justification and may be likened to a man beating on the top of his 
TV sel with his fist to get a better picture, Sometimes iv “orks 


very well. 
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APPENDIX A16 


SUBROUTINES PROP AND RKKJ, WITH RUNGE-KUTTA INTEGRATION 


meee TITTt= OBNP CH AUS XHT. EMT. As Qe XPAR ERAS, I) 
DIMENSTON US (1) .YHT() +e EMTOCL) ACL) XPAR (1). E3AP C1) 
MPHISTON £1(9).F7(9).F3(9)sF4(19) F509) 
| = Gaal 

me xtit( 1) 

ma 3 d=). 

met JYSEtYT C) 

mT INE 

UV=USCT) 

eri (XT LUV ) 

elt. Ps Ft Oe EL XYHT.UY) 

eel p=Xt+Ti/2. 

Pee tyS (141) 4+US0I)) SP» 

fee —HeeP UNIT (XHT UV) 

wat J=h.°c 

Beet J+ ELC I) /2. 

me NTT MEE 

oa L EGUN(A,EHT .0.F2.XHT.UV) 
Seat P=¥ +7 7/26 

See HeFiyhi (XHT UV) 

oe 2? Jales 

meme) (J) +E2(.))/2 6 

ime Tht e 

el L Pee Ag Hit Oe 22 KHI LUV) 

rea ( 1 y=%+)3 

UV=US (7T+1) 

Teme Hee (XHUT UV) 

po 4 J=1.9 

Mert J)=EJ(J)+F205) 

CONT ITM £5 

fee eee NCA. EHT QO, c4,XETUV) 

Beet) Y= X4(T1 4+? o8°T2 425 *T3+TS)/6% 
VBAR (2) =X HT (7) 

XRAR(AV=HXHT(3) 

my > J=1.° 

PP ya TiC A) 420k 2 (S420 ECT IFES CIDE CH oe 4 EST) 
many PMUeE 

Pe 1 +1 

Be TURN 

END 
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POOROUTTINE RKKL(H, TI, alee AT. 0. Fe a 
meee NSTON 75(1).0S(1) ©TSC1) 
COVMOM /PKT/N 

H?=H/?, 

X=X 

T=TI 

A=A7 

R=R7 

D7 [il=1.N 

UV=u(T, xX) 

Walley Xv) 

Peewee —( 1X, UV sAPe wy) 
TN=T4H2 

m= xt }1/2. 

UV=UC TN, Xi) 

WV=EWCT YW) 

et TNGXN.UV.LALR, KV) 
ral XT 2/2. 

UV=IICTN.X7) 

WV=WC TX %') 

feel {yTN,vYC, EV Sek V4 
TO=T+H 

XP=X+T3 

UV=U(TO.XP) 

US(TT)suv 

WVaa( T XU) 

ees YO.,iV. Asa ty) 
ee We |) Cate, T2474) /65 
Ta=T+H 

iS? Tigi T 

VV=EV(TXV) 

7=CV 440 VV 

al 1 I jee 

MONT ELIE 

RFTURN 

END 


ae 
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APPENDIX A1L7 


SUBROUTINES USED IN 6 * 6 MODEL REFERENCE CONYOURING 


Peer ING SEAT Ul: Pe Xs 


Qo 4? 


BEAR AS AE SRE BE REA AS ACAI AC TE ME eK NER Neale Ae OK OM ae ale Neer ake ae ake cles ak oak ye ke toh Seve xe desk teak se oot 


Sea ROUTIME SEAT P 


PURPOSE 
TO COMPUTE SEA TRIAL TRAJECTORIES FUR A GENERAL CCEAM 
feet ee IN ANY SELECTED COMBINATION OF 6 DEGREES OF 
eee USIMG AN EVLER INTEGRATOR 


SUeROUTINGS REQUIRED 
Peers VYMCO,XOIST 


mea CRIPT ION 
eer > (CC) UMN. HAYES THESIS «MI T.197 lot PME DEPART MEM 


a i a oan a SE BS al 


Bae Semrenyeos yea Rous 2s hs ix Be oa of se tek sie heats fc akc aie ate of oe oh ake a ok Oe steals ve ote oleae xeateate ck olga ot ak Bo 
Were nee ON TO (47),0(8 46) ,2(282),7N(28 2 ) 
DIRPENSS ON P(1),X02) >XN(1) 
DPE NS TEN 0 (6),P (6) ,TST (100), ,UST(180) uS(LE ) 
Sere t CN ME(2C) sAV(1L26) ¢XF (126)-,.IN 06), NE(27),1 16) 
DIMENSION X7(6),XNZ (6) 46 X0(46),XDN(G6) « INV (4) 
OMMERSICN LEIIZ2E),LP(E26),UT(18)RVIN2) : 
INTEGE®S AV, XF 
COMMON /OV/MESAV SXFeINsNEeKBol «- KFeol FKP shP 
COMMON /SNOLS/OqReIMVORV 
COMMAN /STEPS/TST,USTSUS 
COMMOM /SINYG/TZ,01 ef 
COMMSN /SUBUT/U Ly 
COMMON /S7CUT/7, ZN : 
OePrmoN 7TEST/EPS EM AX 
COMMOAM JINTGR/NOTSKUeNSTKS eIONE I THPE, KUS 
ree UT NPTCTST,UST,USs0TeTZ91-U?) 
K=L (14M) 
Pet y= (KK) 
XHZ CK) =EXNIK ) 
COM TINU= 
0" 14 a) ee 
XOCJ)=C. 
XON (J)= 9. 
eee RINE 
Pome J=3}eNDT 
JU= SJ 
oes JA=!, KU 
ee SAV = UC IU} 
JU= JU4NDT 
Beee eT IMUE 
CALL OVMOD( ME,AV,XF ePs IN DUI »NE 4 KoXNo XOe XDM, KBGk 7 
feeMer.oy.N=.12ME)GC TO 7 
DO 3 KM=1,KB 
K=L (KP) 
meter es ITHRE)GS TS 8 
KUY =4U2 +K-1 THRE - 1 


iw 
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ey 


ee 


11. 


UEC KUT) SUT C KUT) 4X04 2 *DT 

SEV TANUEe 

ieee Owe GO TO 7 

JU= $41 + (KUA-—1) FNDT 

DO 9 JA=KUA ,KU 

UCJUJEUT(JA ) 

JU= JUAN DT 

CONTINUE 

DO 2 KM=),K R 

KZ= JANE T#(K M2) 

K=t (KE) 

Pitret€ ).EQ .2)CO TO T2 

Ke =A IK) OK) FDT 

LEK ZYEX CK) 

Piers fof (4X2 ))6CT-EMAXIGE TO 6 
Cf Tar 2 
XNCKI=XNCK) tXON CKM) XOT 

CALL XD ISTCINVSRVsl oVNo KyKS ) 
TT Y= XN KD EVM 

Tptees ( Z7N(K 2)).GT.EMAX) GO TC 6 
Memeo yecO.2)6O TC 15 
GOnTInue 

CeayT Inve 

{=} 

SO 10 10 

1=0 

Pelt KW=l. KB 

K=b (KM) 

ACK 7 =XZ (K) 

XM CK I=XNZ(K ) 
Ua ON UES 

eT Use 

END 
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SUBROUTING UINPTCTS,US,UZ,0T,12,T,U) 


a Sea Me Fe nents oe. och pes Sk. TU RW ah cade sche oe Bnei any, of: BS aeetbeck a: Belo, & ot di eviodd. a. 
mB SUBSROUFINE UINPT 

& 

BePURPOSE 

g femoemenATE A TIME VECTOR AND A SET OF COMBINED-STEP- 

c Pumeti@s INPUTS FOR A GENERAL OCEAM VEHICLE 
MeslPROUTINES REQUIRED 

c DONE 

© GeSCRIPTION 

% SECTICN 6 (C),MsNZ HAYES TEESIS »MIT,1972 »NAME DEPARTMENT 
C ' 

c we 4 mis RR ety Rhea eet peak ey CRD pA soks bE ORE Pepe 


eee nS ICN 1S (12),US (P dbo T1117, UCT) Zo) 
Comment /iNTGR/NCT KUNST,» KS: IGNE, LTHRE,RUA 
mb y=1TZ2+DT 

DQ 5 IT=2,N0T 

ee te 1 ( 1 Tle DT 

CONTINUE 

NS=NST/KU 

JU=0 ' 
Woe PU=1,KU 

PST=H=NS*(TU-2) 

DO 2 IL=1,NDT 

woe SUT 

U(JU)=UZE1U) 

JS=1ST7 
DO 3 I1S=1;NS 
=I Stel 

Petes felS))} 33036 

TF (TS( JS) -T(1D) 49% 93 

See =—ULJU)+US( JS) 

CONTINUE 

CINTINUE 

CONTINUE 

RecTURN 

END 


eT) 


MR oa tk 


-e= 





Sere) TE MCROCF (I, PX) 


Pe a 


SUBROUTINE MOREE 


PUP POST 
TO COMPUTE TRAJECTORIES FOkK A GENERAL CCE AN VEHICLE IM 
ANY COMPTNATICN 7F 5 DEGREES CFE FREEDOM WITH VARIABLE 
COEFFICIENTS AND PARAMETERS FOR USS IN MODEL REFERENCE 
IDENTIFICATION 4 USING AN EULER INTEGRATOR 


OvMOr 


—— 


Bes GRIP y irs 
eee 6) MALMO HAYES THESTSsMI T2197] sNeiMe DEPART 


CV OV OV OY OC LS ae ree Gre crn a ve 


ee meme we Seac Hele te te Seite sic aie afk atc ote akc oe ate atc ahs aie ak afc ale ae fe fe ott ate sien He ote ake e See xe FR St ee re 

DIMENSION P(1),X¢1) 
MOBeNS ION 1 (47) ,10846)470282),7N(282) 
Mee IS TON 8 5(29),AV(126).XF (126),IN( 6), Me Biya FS) 
DIMENSION 1° (126),LP(126) 
DIMENSTON X 7(6),XN7 (6) _XO(5).XDN(6) 
moe TOM OY (*9) ,TST(190),UST(1280).US{1 8) 
INTEGES AV, XF 
COM! JIV/HE,AV XE e INeNEsKBel oe KEVLF »¥P ALP 
COMMON /STEOPS/TOT,UST,US 
COMMON /SIMNTG/T7 NT »T 
ee ome /SUUT SS 
COMMON /S7CUT/7_7N 
eeiGiie /TEST/ETS  EMAY 
COMMON STMT GRSYDT KESNST KS gp TONE, I THRE, KUA 
NP 3 RMaL, KP 
K=t (4%) 
X¥Z(K}=% (K) 
MZ (4) =9. 

3 CONT IMS 
feet j=1,NCT 
JUS J 
ee A=). KU) 
ieee y= UC) 
oS ae eT 

2 COMTIMUS 
CALL OVMDD( ME,AV XE »Pe INUIT @NE 9 XeXNZ XD e MON KBs L) 
Potiet 1 OY. MELIOME)GO Ta 7 
C0) 3) (a 
K=L (4K) 
Meee Ee .ITMRE)GE TO 8 
KUL SMUA 4K-] THRE- 2 
ULC KUT) SULO MUTA X(K DXDT 

B CONTINUS 
Hen JELQ.NDTIGO TO 7 
SUS S424 (KURA L)ENDT 
DO 9 JASKUA KU 
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ULJUIFUTISA) 

= JUAN OT 

SereiihNce 

wee Fyi=',K® 

7 ert) Pox ( KK =) ) 
K=L(K") 

AUK J=EXCK)FEXO(KM) EDT 
Peer )=Y (KH) 

Mest 7 (K2Z)).6.EMAXIGO TO 
Cee INUEs 
oan f tl) '- 

=] 

om T) 70 

T=% 

We =k Kitt=1, KP 

K=L (“6 ) 

X(K )=%Z (¥) 

Cie ihe 

RETURM 

END 
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¢ 
SURRGUT TME gg Clee WL tts a Ne) 
Beals ok ae Heke se ae ates ale He aes Hs rake sheals ale tt ays ate ake ga ake of ate ak ke te ake deat te ate Pee ate ate AHH MWe ye As teste He ke aie aie Me He Fe He 


SeeROUT ING STOU 7 


Boe PASE | 
eee ATE AND TUTPUT PLOTS CF SEA TRIAL ME1SY AND 






SECTION € (C) yM.NZHAYES THESIS MITSIOTI NAME DEPLOTMEMT 


iC Bee. > TRAJECTORIES AND PLOTS OF MEHICLE PMPUTS 
c 

MeeoUeRCUTENES REQUISED 

t. all 

9 

meeDESCRIPTICN 

C 

C 

‘a 


Hee ae sts Mees As ake as Se meas aie Pe Kose of she Seats oie te sic als ate of oh als ais aie aks ate te te seats ate ok ce ote cle fe Seats ote oe ate Po ats Pe te ah ate te ote ot: 
mr lion DV», XF 
mS) 113,002) .203242N09),ZPL( 376) 
DIMENST ON ME(29) ,AV(126),XF (126 ),IN(6),NE(27),L (6) 
Giger 2 Or tL (126 ).t O(126) 
COON JOV/ME,SAV XE gs INJNE, K Bel KEL EF ,KP LP 


a fe RAT ( Lt 1OXy NCL SFLESS UsVeOR WSs OX, PLUK NM) = Flee 
oe eerPAT (C CH OX, NOT SELE SS P49,0P RI, EX, * LE Kem) =P 2) 
32 FORMAT( 3H .*%0Xs'NOISY UsVr OP Wl, 5X, LEMP a, 19) 
B53) FORMAT ( LH Oxy IND] Sy Pegi & R* 8X, ‘L( Kee 
3 


meee TH » 0X. * TANKS J—-PES.2-STRD. 32-PORT, G=FwOm™, 

7 *5— ATM 4—-F WOW, 7-AF TW? ) 

ae OF Me fT ( tH ee oe 1-Me LTA P,2-DEtITA » Fee. 
7g OS TD Y=4Y, re 

Be SRM AT (TH , LOX, © ORD PEL LOR 1-RPS,2- PPS/SEC © tRPS=4+X!) 

7 OMe RMAYT( 114 .° OX, * THIUSTFRPS T-YFWD,2-VYAFT ,2-7EIWD, 4-Zhe'G 

Dal See ty gy thy — 7 9 ** * ) 


Seer (ye 4 1 0X,' ANGLES 1-PHi a 2-1 Reta 2a ae 
WUI= & 
C Meee FUN) TMT™™ 7PLUNMAKEN) 


NPS A="P 
te oe K=1.N 
moi = 1(K) 
1 CONTINUE 
meme (9).59.0)60 TO 2 
NC=2 
ND=2 
eo rely 
K=L (KM) 
JZ=N* (4 M71 ) 
Maeooom. 51G% 1 4 
ge=W 
Pe 5 KMeL.N 
JZ= 57+) 
J=J+2 
mei sy= 2152) 
> Clim 1 Mis 
Br PPL ST (TP, ZPL ON. NC, O) 
met 7 eth W,20 K 
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< 
’ 








t 


re OS 


EO 


1a 


=] 


a 
14 


NP=NP4] 

GQ Tn 2 

J=N 

mar 6 mine), NM 

2 = hi 1. 

Se J+) 

ZPL (3j)=27(57) 

GGNTENUE 

NP =NP+ 1 

Bee PLGTINP,ZPL yN,N 
Vee as 
GON 7 WILLS 
Wee ) CEO 9G" TT) 7 

NC =? 

NO= 7? 

Ao § eYst kK 
K=L (KM) 
J7=N%(K M1) 
Mees .G?! .3)GE TT? 9 

d= 

Peet o Kit=1, 8) 

JZ = 807 4-3 

J= 347 

PPiweJ)=7N( 52) 

eNTIMISE 

NP= NO4 4 

Pe PL OTINP,Z°L Ne NC.O) 
WRITE (KW, 27 YK 


wd 


' 


ee mo e 
JEN 

DE 11 KN=1l.M 
w= JZ+1 
Je J 402 


Meet) = 2S 2) 
Gan © Waves: 
NPaN O44 
@eLte PLET(hP,Z°L aN. ND.0) 
WEY TE(KW,37 7K 
GN T day 
eee O20) GO TO Le 
Motes jee 20155 To 12 
Jen ; 
mga ef hel) -)) 
WO=NEf1) 
BO 314 JT=1,NC 
Pe 15 KN=1,N 
J=aJ +2. 
NUS NLJ+ 7 
MPS =UINU ) 
Caat rive 
GENT ENUE 
I= NOF+] 
NP =N P+? 
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Go" it — pelus .* ; ' — 
' 1 ’ - ' r7 teise- | 
eapari st) | 


Oe REO@TINP.7PLIN.NO,0) 
eee. .0)GT 10 Lh 
J=aN 
NURHNKC(NE (7) -7) 
NO=NE{7 ) 
Ome byes T=1,NN 
DO 29 KN=i,N 
J=J+i 
NU=NU+ ] 
ma ( Jy= UCN ) 
me CON TIMUT 
im CON TIAUS 
oa NO+7 
NP=NO+ 7 
eee TE T(N.7PI yh. NO,0) 
mort “V2(4),EOR0)6C TO 19 
J=! 
mea MeCN E(S)-)}) 
eo] Ne? ) 
DR 20 JI=}_y NO , 
oe 21 KN=},N 
J=J+1 
NU=NO4? 
Pett sy Suit Nt! ) 
eee (NUS 
mo seo TINS 4 
NO= 94 2 
RP= NP] 
meee AE INPYZPL ae NO,0) 
weet K W,26 ) 
See ts ).59.0NC TO 22 
JEN 
NUH=N2({ ME (9) —-1) 
NO=NE( ) 
OP 73 JT=1,n8 
DE 76 Kh=¥e N 
d= J +2 
Nil= NU + 
mead) UCM 
Bee NT PMU & 
me OR TINIE 
NO= NO+] 
NP=NP+) 
CALL PL&eTINP,ZPLN, ND.) 
MRI TECK W,37 ) 
pee e (1 S).E0.0)G0 TO 25 
Mel7ie(é,26) 
Pe PEORYAT(SX,* ANGLES ARE INTEGPATED ANGULAR VELOCITIES) 
Meme e{70).F0.0)00 TO 2 
J=N 
MO=NECNE{LO)-1) 


WwW 
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Ne , 
> 


mat 


~<a 
Hi 








eereqte tay 
Unt & . 





+h 


me=NECS ) 

Be 28 gf=i1,NC 
He 2° Kei + N 
J=J+i 

Ntf= NOl4 1. 

ZPt (J)=UCNU ) 
22 CONTINUE 

Be CONTINUE 
NO=NO+1 
Nigar +3 

Game PROTIHNP,7PLIN,NO,O) 
eT rete Ww, 273 ) 
#2 NP=NPSA 

BE YURM 


en) 





ditional Subroutines 
OVMOD = Appendix A6 
PLOT - Appendix A5 


XDIST - Appendix A7 


Filly 
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APPENDIX A18 


SUBROUTINES USED IN 6*6 EXTENDED KALMAN FILTERING 


SUBROUTINE EHDOT(X,U,P;E; XDyED) 


DRS A ART Ae ee kg am ee eR RE Ree Ree 


SLBROUTINE ERDOT 


PORPISE 


TO COMPUTE THE DERIVATIVE OF THE ERRCR COVARIANCE MATRIX 
FOR A GENERAL OCEAN VEHICLE KALMAN FILTER 


SULVES THE EQUATIONS 
EHDOT ~- EC=FFEtEXFTRANS+Q 
F ~ OVOER 
XD mame vine 


meeroul INES REGUIRED 
OVMO00;CVDER 


BEsCRIPTION 
SECTICN 6 (C)sMoNHAYES TRKESISsMIT;12971 sNAME DEPARTMENT 


MSS EF SME A KES eS: oe ae ho Se wK Ae ple Re hess HI BM oh |! Bw MSs. Hohe KY pe ge a BE ay 


m Nm & 


Pere N STON X(17,U01),P(1),E01),xX0(1) FED) 
DINENSICN HE(020),AV(126),XF0126),1IN(6),NE(27) ,L (6) 
CIMENSICN LF(126),LP0126) 
DIMENSION Q(6),XN(6),XND(E) 
DIMENSICN F(1200),R(6),INV(6) pRVIL2) 
INTEGER AV:XF 
COMMON /SCV/ME,AVaXF,IN NES KByL KF eL Fo KPyLP 
COMMON /SNCTIS/Q,ReTKVSERV 
(eee uLATE XO AND F 
CALL GVMOD(MNEsAVsXFePyINsU,NE9XeXNZXDyXNDSKByL) 
CALL CVDER(ME,U,AV 9XF,y et LFaKBylyXeKPyhPyPy_FyNF NE) 
CALCULATE THE 1-ST KB*KB TERMS OF ED 
NV=} 
N=] 
DO 1 J=1,KB 
DO 2 1=1,KB 
EC(NV) =O. 
DO 2 K=}),NF 
MF=T4+KB? (K-21) 
Met=ntNre(J-1) 
EN(NV)=ELCONV) FC HE) SECMFT DFE CHE) FCNFT) 
CONTINUE 
Drees, JIGOD TO 4 
ED(NV}=EC (AV) +Q(N) 
N=N41 
NV=NV¥i 
CONTINUE 
CONTINUE 
CALCULATE THE REMAINING KBS(NF-KB) TERMS Cf ED 
NR=NF-KB 
DS 5 J=1,NR 
DG 6 I=1,KB 
ED(NV)=05 
DO Y K=1,NF 
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ME=14KB% (K-21) 

METSKANF Ee (I-12) 

ED( NV }=ED( NV) SF (NF) SE (MET 4 E(ME NSEC METI 
7 CONTINUE 

NV=NV4L 
§ CONTINUE 
5 CONTINUE 

RETURN 

END 
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AIADAADOAIAAAAIAAAYANHM 


it aoa as ese moan y EG) 


“Re ooo. oR ae Oe DS Oe Ol Pe ee SO ee eee ee ee De ee eo ee oe ee a 7 ee on oe oe oe ee | 


: ° oar . p - Png 4 , a . 9 
. caer " a >: 3 @ . aoa it. se a 5 eo Pw ts, ware 4, 4 4? Bae wee |e whe he op tae 2 + 1 oye 8% a ei 2 
oS & % cnt Ke sy 04> py Bi is tats ah oo op tc, "£76 Ke oe. ut Pad ey a ot * 2 ye fo Djs sy: 4° “a "° a gt ge ye ASO 2 IS VK 


SUBROUTINE KGAIN 


PURPOSE 
TO COMPUTE THE GAIN MATRIX FOR A KALMAN FILTER 


SOLVES THE EQUATION 
GATN ~— EG=b4VEFR) IRV 


SUBROUTINES REQUIRED 
MINV (CIBM/SSP) 


DESCRIPTICN 
SECTION 6 (C),HMsNoHAYES THESIS, M1T,1972 sNAME DEPARTHENT 


Bi oe 
a? 
° 


o*¢ 
“3° 


rm 4. ON 


3 
2 


8 


Rice S 2H By PES SMS Ree RAD ERM EES. LURRARRES SRURSERH AS 
DIMENSION Eli) EGIL) 

DIMENSION R(6),E1(36),LV(6) sMV(6) 
DIMENSION Q(6),INV(6),RV(12) 
COMMON /SNGIS/Q,R,INV RV 

FORM MATRIX INVERSE OF CHEN T+ 3) 
NV=] 

N=] 

DO 1 J=1,KBE 

DO 4 IT=1,KB 

EI(NV)=EC(NYV) 

PEtieeCo3)C0 TO 5 

CET TOs 6 

EI(NV)=ELTCNVIFRIN) 

N=N+1 

NV=NV41 

CONTINUE 

CONTINUE 

CALL MINV(EI,K8,sD_LV,MV) 
IF(O05EQ.05)G0O TO 8 

FORM GAIN MATRIX EHTCHEHT*R) INV 
NV=1 

DO 2 J=1,KB 

DU 32 IT=1,NF 

EG(NV)=0> 

DO 7 K=].-KB 

IK=IeNF(K-1) 

TE=K+KB*(J-1) 
EG(INVI=EG(NV)FECIKISETCIE) 
CONTINUE 

NV=NV41 

CONTINUE 

CONTINUE 

RETURN 

WRITE(6;9) 


SOFORMAT(1X,* SINGULAR MATRIX IN KGAIN, ' 3% 


L°SETTING EL=1./DIAG(EI) *) 


EPS=le CE--40 
“a7 








10 


IKB=KB#¥KB 


DG 10 K=1,ITKB 


EI(K )=0. 

CONTINUE 

DO ll K=1,KB 
IK=K4+K BY (K-12) 
EIV=ECIK)F+R(K) 

IFC EIVceEQo Cs FEIV=EPS 
EIT(KI=1o/E1V 
CONTINUE 

RETURN 

cCND 
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SUBROUTINE UPEAT( 22x; Es EGeXH; EHy KBy NF) 
Goh a osssh aes abopcieth tegecdest ade he ateay sha deo tap tok eacksh draaty, erage bale ee sal dag da 
C PLRPOSE 

TO COMPUTE THE UPDATED STATE VECTOR AND ERRER 


PECTION G™*UCTS MENS HAVES THESIS,»M1T,1971 ;NAME DEPARTMENT 


C COVARTANCE MATRIX FOR A KALMAN FILTER 
C SULVES THE EQUATIONS 

C State — APUPDATED) =XHtEG*( Z-XH) 
C COV, - EHCUPDATED)=EH-EG#EH 

C 

C SUBROUTINES REQUIRED 

C NCNE 
C 

Mm VESCRIPTICK 

C 

c 

C 


SS RM AC eae ES ee Ne ESS RE EO RR eRe ae ea. MEO ets Me an eas zea eA a eek ae he 
DIMENSION 2(1),X(1),560173,EG(1)3XHK(1),EHC1) 
CIMENSTICN XZ(6) 

C FORM Z-H=X 

D3 J K=1,KB ¢ 
XZ(K)H=Z(K)—-XEK) 

1 CONTINUE 

. Wieiee ees lhe NF STATES; XH 

Dero l=) Shr 

XH( 1 )=Qo ' 

DO 2 J=1;KB pet 

WE= ] First J-1) ‘ 

XH(I)=XH( I) FEG( KF) XZ( J) 

CONTINUE 

CONTINUE 

C UPCATE THE (NF#{NFtH1))/2 ERROR COVARIANCES; EH 

NV=1 
pa 4 J=i3NF 
DO 5 J=1;J 
Tei la@Gi.ekbjiGO TO 7¢ 
l=] XBe4q J-1) 
EHR(INV)J=S=ECKT) 
GO 19 8 
YT EH(NV) =O; 
8 DU 6 K=]1,KB 
KE=I+NFs (K-1) 
KI=K+KB*¥( J-1) 
EH (NV) =EH(CAV)-EG(KE)“ECKI) 

6 CONTINUE 

NV=NV+t1 

CGNTINUE 

CONTINUE 

RETURN 

END 


tw PO 


a2 
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APPENDIX A19 


MAIN 6 * 6 IDENTIFICATION PROGRAM STATEMENTS IN FORTRAN IV (MAIN 








Oe ae eg to So Se slo of is ae ard shai xe 
ee eg aye Ge 2x He Ho 2k 6 6 AK He HE NS ok Se Hs He Ff SME RE Ee MOR oe a: Me ieee an Stee Se RS eee oe Sear 


Se 


- Ye 
-<- 


Mmoer REFERENCE AND KAL “AN FILTER PROGRAM FOR THE SRV 


PUR OSE 
TO STUDY I[DENTIFIABILITY OF THE SECOND DEGREE AND EFFECTOR 
COEFFICIENTS GF THE DSRV FROM INTERNALLY GENFRATED FUL 
SCALE SEA TRIAL DATA. 


LANGUAGE : FORT&AN LV 


SUBROUTINES REQUIRED 


Mere Lely) CORE APQHITREMENTS 
Memes 0/65 250k BYTES 


AUTHOR 
(ae C= eas ih + ( ae Z 
Seeeereel ME HAYES 42%.5-23233.4M1T EXT. SA07 
de ate J “he We al 8, So * ! oe ins «ae Se we we Sr wle de we Je to te aly x2 So fe ote te te So ake ts ote de we ale So ale als ate ole we wl J. Je wh A A. J 
ae AP 34 Cd ad ca CF ht blll tl As > oad bl ahi { Ayah Me™ Qt eS Em Meh MGM Oh BY ge Ah SQ® Oye MQ ® SY MG Og* 1% %: ~~ 4“ a > 4" "> => "9° a aloe Te “4° 4 aA: 4% by Doo ry Ga nd *~ ° ‘c 


DECLARATION STATEMENTS 
DIMENSTON YE(27).AY(1L26) »XF0126),1IN(5)yNE(27)5L (5) 46) 
Pees IWN LE (126) ,6°(126) ,29606),P6(8) ,U(LS) R15) , P1537) 
DT ME} a Polo 8 1) s+ Xt 255) 54812593) GX NOZ as Mid 
VIMENSIO amet ZC Gps ELIZ) si (122 "™) ¢ Ts C10 
Mere? FBL (5) ,TRBLT( 12) ,JBLI (CLO) ,ASL7T A 1) 
ee eo FST (18) STIRS ),0N(6),R8N146),US01S5) 
Peso lON [ARR(G),JS*WR 16) ,1 X18)» SXW(8) RAW) 
DiteNSION LXW(S) ,L at 12h) 
DOeeNolON “OP{14) -NGP(14),LFP(537) 
Wee. tte C747) ,CM(91),C0OS7T(2397) 
Dien (OM TARE (4),INV(6)—¢RV C12) RT (4) 
Pees tON X(NC(253),PINC(587) 
DPE NSTON 7(47),J90(844) ,7(2382),2N(232) 
Ooo XSIR(252),PST2t587) 
Mote Ge, AVS4XF 
meee POL/ BS, fL ty tO*,*Ch, Fk? /s 
meme Ne s/t yt, ty¥t yt Zt Ky MI Ett / 
TNTEGES Rey tl g OYE Pe ee ra Ry 
epee TRF /Sipt,tAt,'St,'§t/ 
Copimtre /QV/ME,AV,XF,IN NE, K8,L,KF,LEF,KP,LP 
COMMON /SNOTS/O,2 ,INVYRV 
COMMON /STFESS/STST,UST,U 
COMMON /SINTG/TZ;,0T,T 
COMMON /SUQUT/UD 
COMMON /SZOUT/Z.ZN 
Commer /TEST/FPS,ENAX 
COMMON /INTGR/NDT,KUSNST KS STONE? TP THRE, KUA 
KR=5 
KW=6 
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Ss 
G 
C 


i Ds a as a 


te Xs als ok os ok oe ok tks fo ok 
>: AE AR 8 KR OK SAS I 


BS MA FS AS FG AS HET TE OI SAS OK OS TER AK AE AE TRS AS AK AS ae oe Pe ae ie ee ak os ie ak ok Xe de ie ase Ae te oe 
PiTIAL PROGRA™ DATA INPUT 
OREAD(KR, ae mes At aeNEy MP, KMV, XMPYKPF,KX,KPG,<U, 
YNHMAXNINO,NIN NST,NOUT MSLTZKNPENMRT 
Sees KF IL, TONG, NCN WC) 5H, TAS9, ITHRE,KUA 
READ(KR, 2°04) 1SIXT,ISEVI,XCH,KEF,EPS, EMAX 
POS FORMAT(415,2610.2) 
READ(KR,I2LINGPI, (MGP(5),J=1,NGPI) 
err 122) GNGP(J),J=1,NGPI) 
121 FARMAT(I4,1414) 
fie2 FORMAT(141%) 
Bethe. 2) 5S),J=1,KS) 
eee | PC STI), J=1,KYME) 
DN 4S J=1,KS 
Pa = Seri i) 
ENVO J) HJ*1 OL 
Caine 
pe AAT(2C14} 
Seana (4°12) 
pee ( 1 FS. 2) 
Penns 2 CAV (J), J=1,XAV) ’ 
REPO (KR, Z)(XF (J), J=1+KAV) 
pee (Kh, 2) (NE( J) ,J=1,KNE) 
D0 4 [=1,*MP 
@y-™ME( 1T+K4V)-1 
eeu 2.3) {PS(JI)- =4P, HV) 
Peet i +X 4V} 
& CONTINUE 
Pepe 4) (PS(J);J=49, KY) 
Oe KR 4) (XS(5),J=1,KX) 
Be KR; 3) Po) JL, KPS) 
Peek, 27 CIS (J), J=1, KU) 
meee kee GS) (XINC( I) »pJ=alL, KX) . 
pmeexRy*) (PINC (J) ,5=1,*NP) 
REANCKR, 39) 05,XH(J),IS=1,KX) 
Wenn 39) (J ,PH( J) ,JJ=1,K NP) 


WJ ND re O 


Me ste te SK nk ok she ofc ke ts aie ok ote te ste Ye ste ais Be te ok de te ale ois oth de ok oe ots 
AEE EK OK OE 3K * “> 4% al Dale el ali dla bolts ole lite Dis ve Gos ath 


INITIAL STRUCTURE SEL SGte. Sere 
Paie2e i J=14ykS 
L(J}=6 

POC C@eHTINUF 
KB=0 
Demos t=),S 
KB=KBtM( 1) 
Pe WeeiYS EQ. LIL(KS)=1 

5 CONTINUE 


we Se So ats ate of ots y: we te ale ute Vo 
FE AN OS > ASAE aye ye AS 


Me ok fe kk cfs se ahs oie ke Aa te kc as Ke Sc oie ok fs Me ste ke ole ake Re te Ne oe he Ae ie He RE as RE Ae aK a ie ais yc He Ae ats ak ie i akc ae oe a a a 
eat fee GUENTITIEcS TO INITIAL VALUFS OR Pe ZERO 

Ome af J=1,KX 

X(J)=XS0J) 
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— 





181 


18? 


1&3 


184 


Ze) 1 


2032 


me 3 


13 


14 


69 





rote YaNS (J) 
XSTRIJI)=XH( 5} 
CONT DWE 
DS E81 J=1,222 
THOS) =, 
ee JHC. 
C OMT INVUE 
ieee Se], 72397 
GOST ( i)eo. 
CONT PNWE 
OG Whee J=1 eh b 
Ie J) 
COT INUE 
56 124 J=1,NOUT 
lay ( J)= 
GaeerT Tee 
DO 20) J=l,NIND 
PFBLT{( 2) =9 
weet ( J7=C 
neni Ce 

Ge (NUE 
D9 BO? J=);51 
CN(J}=9. 
CONT INYE 
DO 263 J=1,4 
ied) =). 
PU R=o 
(ONT [Vic 
Daas J=1,<NP 
paorr= P'S { J ) 
ree IEP rH ( y) 
CONTINUE 
KF=O 
KP=% 
DN 9 J=1,KAV 
le ( J} =@ 
met J) =9 
CONTINUE 
Creer Ssewat, KEH 
er) =). 
Carry Prey 
BO 4 J=1,K Er 
et Jeo 
eH =0. 
COnrrnve 
OGNSG J=1,KS 
Q(J)=0. 
R(J)=9. 
QN(J)=0. 
RN(J)=0. 
CONT IENUE 
Vesa J=1,NST 
eoeet J) =- led 
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g 
xxx 
C WRI 


269 


Sit J)=0. 

rey NS 

wes =US( 3) 

CONTINUE 
Be Bee Me ke ete eke Hee oa eae te eae eae ae ak He Ne ae te eae Rea ae ok teak te 8 
me INITIAL DATA EgR. “REFERENCE 

WRITE CKY,91) 

WRITE (KW,253) 

me weit 1X, 1 190" )) 

WRITE(KW,254 ) 

Meee ry 54X,' INITTIAL DATA, 54%) 
WRITE (KY, 92) 

WEITE( KH, 255)KS  KME  KAVIKME g MP KV SMP XPF KX KPC KU 
GFORMAT (In ytXe' KS =',14," KME=",14," KAVE', 14, 
1! KNE=',14,° Pir S| ee K"V=',14,° K4P=',14, 
Qe *414,' KX =?,14," KPG=",14," Ku =',14) 
OHARITE(KWs 269) MIN NST,XKNP, NINO NOUT,NALT,NERT, IONE, 
PAB, KEF ; 


SFORMAT(LH a1Xy' NIN ='y14,? NST =",14y7 KNP ='yI4, 


1s eee | Tet ees NBLEH%,I4,' NYRTH', 14, 
Peete ="y14,' TAGO=', 145" KEF =',14) 
WRITE CKW, 256) NHMNAX,TSUXT,ISOVI,IT THRE 


Beer mA (Cri y1X,* NHYAX =",14,% TSIXT ='s14,°* ISEVE =*, 


Bot) 


22 


23 


254 


26> 


114; ° TTHRE =',14) 

MEETTE(K<W.29/7)MREF,KFIL NCD yNCN NYR  REH,NGPT 
EORAATOIH elk pee a icy * es ise gn NOD a ee 
Moe rli. =*%_5 15, ! (NGveep = oy, | Minty = (ayer, * NGO?PT=',15) 
WRIT e(Ke 258) (de 462(J)sdeL NGPT) 
oe sLXeIMGP CJD =H1,4%,1401X,12,'=',13)) 

Mm ETE C4759) 0 IsNBPCI),J=LsNOPT) 

FURMAT(1HN y1Xs'NGPLJ)=! 1 ee 
WRITE(CKW,250) (5940 5)3S=1,KS) 
ferret iit y 1X (HC J) —-',56(2K%,12,'=',12)) 
ee rales 261) ( Set (Jey JH] 41°) 
MPITE(KW, 261) (03.4F CJ) ,J=11,«%"8) 

mee AT (is 41X,'ME( J) —-',1902%, 12, °=";, 14)) 
WRITE (KW,262) (05, IN (J) .J=15KS) 
Merde sh Xe' INC J)—'s602X,7T2,'=%51 7d) 
MRT TET KR 7603) (JRTNV (J), J=1,KS) 
Roma t tit gix,'INViJ)’, sae 12,%=',17)) 
WRITE (Kh 2 Wee) (J,NECI) d= 1,14) 
mimo i 5g 1X, * NEC J)-? i ae 
WRITE (Ky 264) (Sy NEC J) ) JEL 5, KNE) 
JO=l 

JT=14 
Be 265 1=1,8 

WRITE (HH, 7266) (J,AV0J),J=I05 JST) 

JO=JT+1 

Jt JT+14 
CONTINUE 

WRITE (KW, 256) (3, AV(J) 2+ JS=JSy KAY) 
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266 


ZO l 


27% 


ig 


Bi2 


214 


Ae 
271 


278 


premmrr A tens AVC SJ)—-',14(2X,13,'=',12)) 
JO=1 

J1T=14 

poe 2o/ t= 1,5 

WRITE(K' 263) (aes x ( eJ=JO;, JT) 

me-JT+1 

LT ae BL 

CONTINUE 

MeRLTECKW,265)(3,rxF(5),J=J0,KAV) 

meee eG tt ghey * Xi (J)—' ,14(2%,13,'=!', 12)) 
melt e( hye 9 1) 

WRITE(Kin 253) 

ARETE (KW ,254 ) 


MRITE(KY,92) 


JC=1 
T= 5 
Poectis J=1,.51 
Meee gs 21} (J,;KS(J),5S=J9,J7T) 
vOo=J1+1 
JT=JT4+5 
CONT TINUE 
melee thwart li S,XstJS).J3J=JC, KX) © 
Peet yg 1 Xy'XS(I) -—' 4, 503%,135'=',F13.47) 
Beer ret kKwW,91) 
WRITE(KW,253) 
Mth! TE(KW, 25%) 
WRITECKS ,92)} 
Ji 
JT=5 
peee2?2 1=1,51 
Pee 27 3)( I, XLAC (I) JHC, UT) 
JO=JT+} 
apa 5 
CONTINUE 
Riemer 275 )4 I, XINCCI), J=SIy KX) 
Pees) gd LX, TAINC (IU)! 51 2%,135;,'=",F 1224)) 
rSyw=1 
v=) 
JT=5 
MEILTE CKO!) 
ee) TEAR yc 3) 
MRITE(XH, 254) 
WRITE CKY 1°?) 
ieee o> 1=1,51 
Mier e(Key2/6)(53,PS(S)-J=I0,J)) 
JO=JT+1 
JT=JST+5 
CONTINUE 
GUio (277,273); 1SW 
Pod 2 
GO TO 274 
WRITE( KY, 91) 
mee Ke, 2 53) 
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VW 





WRITECKS 49294) 

WRITE (KW,92) 

DO 279 t=1,15 

WRITE(KtYi,2 76) Poe ole I Oy.JT ) 
a= J1+)] 

w= JT +5 

ma? CONTINUE 


Peet Kiy 276)(3,PS(J),J=J9,KNP) 
eo rAt CH «IX,*PS(S) -—',5(3K,13,°=',F13.4)) 
TSWe] 
JO=1 
JT=5 


Be WlITE (Ks 91) 

WRI VE (Ki) ,253) 

WRITE(KY'1254) 

Pore) 1 EU ¥ably 9 2 } 

eee yy i=) ,5)] 
ements cee }{ J,PINC( J) »JaJG,JdT) 
Oe) 1+) 

y= 37 +5 

me) CONTIWUE 

GO TO (283,284),1S\ 

mao | SWw=2 

eo TO 284 

moa WARITE(KW,91) 

WRITE (KW,253) 

ARI TE(K+s;254) 

WRITE CK ,92) 

Peeco> 1=1,15 

Peet ayy 2 52)(5J,PINC(S) ,J=J9, 57} 
ie) + 1. 

w= jh) +5 

moo CONTINUE 
WRIYTECKY,282)(5,PINO CI), J= 
282 FORMAT (1h may eC CS 5 (23 
MRITECKY ,92) 

Mee Te hes 236) (5,PG05),J=1,5) 
eieeviny 9 20O)(5,P3o( J) ,J=5,K PG) 

eee ee it gi X,' POC JS) -—* ,5(3X%,13,'=*,FI3.b)) 
WRITS (Kyo 2) 

Pee OMT) I, US (J},J= esa) 
BRITE (Kw, 287 )(J,5US(5),J=7,12) 

WRITE (Ky »2287)(3eUS( 5), I=) 35K) 

Meetor, siti ,1X,*US(S)',6(2X,14,'=',F13.4)) 
van eC Ke, 92) 

WRITE(KW,283) 

Mee rURMAT{(IH ,1X,529%,'"END OF INITIAL DATA") 
WRITE( “Ww, 253) 

WRITE (KW, 253) 

WRITE(KW,92) 
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beteat Deol ~ . 
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REA Ot) THE NUMBER GF BLOCKS AND TEST POR 2 SEGe kK Gee 
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oo oe 3 ale at 2 ate awe at a ah we af. at. ale Qt si au pia 
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Sad a i a a 


wie 
a 
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at 
ee 


ieee 
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> 


16 





Ly 
19 


ae 
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m PEG 
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289C FORMAT (LH 


ate rs = 
“- “~~ ad 


READ BLOCK 
eee ies PP SLONR NPR, 4p TEs IL Fy TL Pe TX iP pT yg ling TUG TST, 


READ(KR, 1) NE 
Petit, Loy SLI (d),J=1,NBLT) 
meRnAT(5AL) 

N90 16 J=l NSLT 
moreno ls Ne. PBL (3) Ga 
mo) {MUP 

MRITE( KS, 289 )NE 
fee ee ARE 
mesoel Mee (HIS RUN.) - 
WRITE (CKW,92) 

WRITE (KW,29%, } 

Me raeettt »lXs'OLGIN FIRST BLOCK’) 
PRLTF{(Kw,co2) 
WRITE (KN ,253) 

Pe p= Neo } 

1LCN=NGN- 1] 

GO TO 18 

meen, IOP CIBGLT( JS) 3J=1,NBLT} 


Toe 


Poa 


elLOCKS TD. Se PRU e 


9 


ws IN 


POrMA1(1%,5A1,5X,* INITIAL PROGRAM DATA GAFGR *) 
Sao? 
ect Werte See Omen 3s fe cme sc SS Se He is Mis Sic se siz Sis ole oie Se Ss sie Sie = sl i Ae I beet rad ebay a ae 


memeloes., CALCULATIUNS 
DO bo P3=LsNB 


rv, 


Cree INTE IAI ZE SULLECTED Sean es 
PirATi, (PH, fe indy INk, TO 

Geese Ne. GD TU 
Mm 22 J=1,;,KS 
fl J) =G 
CONTINUE 

Meet cee NE. 9)G) 
DD 24 J=lyKitV 
Wet J) =4) 
COMTINUE 

Me ie ein: ot) 40 
yO 26 J=1L,KAV 
tte vol.) = 

Con CRUE 

Perel test 6/2) G5 
Mo, 25 re ey 
1P{J)=9 
CONTINUE 
Peewee. eJCGO TQ 29 
Woes: J=i,K*X 
Rr =X SS) 
XN(J)=XS(J) 
iNT NUE 
tere aN. 0 GO 
eUnoe 7-1, KP 
PQS) =PS( J) 
CONT TNUE 


aa ‘ 
(pees: 
TA 


22 


1G ee 


iO, “eel 





Deere tilt .NE@O)GU TO 33 

DO 34 J=1, KE 

tO) St) 

34 CONTINUE 

Pee itF(lOaME.0)GO Ti) 35 

oeso 9=1,KS 

OL J=0. 

36 CONTINUE 

Boe IFC iIR.NEw9)GO TO 37. 

ony 36 J=l1, KS 

A 

36 CONTINUE 

37 IF(IU.E.C 
bf 
) 


reO Tare) 
KU 


09 82 J=l 

UO(J)=US(J 

me CONTINUE 

Seri) Slee 0 )GO TC G2 

Bao 2 VJ=!),NST 

fee y=—1. 0 

eat J) = 0% 

63 CONTINUE 

Meir tiING.WeE.C)GO TO 64 

265 J=!1,KS 

QN(J)=0., 

Bo CONTINUE 

64 iFCIMR.NE.OJGC TO 66 

YO 67 J=1,K5 . 

RN(J}=%. 

67 CUNTIMNJE 

Cee) SWE.) TO 113 

NOe7 i J=1,N0uUT 

TOUT (J)=9 

fe CUNTINUE © 

Mee IPUixXH.NE.S)GG 10 114 
Memes J=1,KX 
meee = XSTRI J) 

mrs CONTINUE 

mer fF(PPH.NE.D)GD TO 76 
DOM enor d=) ,K NP 
eee S 1 i. (J) 

Pho CONTINUL 





C evi CHANGES T0 SELECTED VARTABLES 
Se iment 15(15;,F11.4)) 
~ 40 FORMAT (CIC(14,14)) 
Poe REM Ke, 46) (IT SLT(J),JBLTC J), J=1,NIND) 
90 41 J=1,NIND 
KA=IBLT(J) 
Pagers )GU TO 42 
Moy J6L T(J) 
41 CONTINUE 
GU TO 76 
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Sel bme STRUCTURE SELECTOR 
me KADH=C 
DO 176 J=1,KS 
KB=KB+44(J5) 
Meee eee.l )L(KP)=J 
PYO CONTINUE 
Meese AU Keea (LBL IT(J),J3BLTCS)  J=l1yNIt)) 
mono 44 J=1,NIND 
KA=IBLT(J) 
(eevee tev )1G0 10 43 
Met KA y=ISL T(J) 
44 CONTINUE 
GU TO 199 


Meet Jide VARITABLCS 
Pm READ( KR, 2) 12,06 
READ(KR, LINOT »KF,KP 


READ IN CHANGES TO SELFCTED VARIABLES 
45 READ(KR AQ) CIELT( IS), JBLTOS) JEL NID) 
Sn) 6) ENS Gale: 
mere rt J) 
IF(KA.LE.0O)GO TD 47 
Wee) =J8CT(L) 
46 CONTINUE 
pero 45 
eee KR, GS) (LSPLT( J) »JALTt(J) ,J=1 PR) 
Dame JS), Vis 
KA=1TeLlT(J) 
NECA Lee) oO TO 4° 
eet = J3eT{ I} 
48 CGNTINUJE 
corr 47 
meme ( ke, 29) (1 SCT( I) -ABLT( 3), J=1,NTY } 
Pee J=1, NIN 
pe eid (4) ) 
Meter ea. )GD TN 51 
ecm Apl T(J) 
eet T(J} 
ee Cla IAUE 
BS Te 49 
Mee ee (he. 39) (PSL T( I), ASLTCJ)JH=1,NI™ ) 
Oro e J=1,NIN 
aoe (J) 
Negev ebe.cyGo TC 55 
P(KA)=ABLT (J) 
52 CONTINJE 
GO TO 51 
meer, ZO ){TSLT( J) ABLT( J) oJ=1,NIN ) 
DO 56 J=1,sNIN 
eee T(J) 
Meee LE.@)GO TO 57 
Mieay=A8LT (J) 
a, 528- 











56 


| 


53 


Do 


68 


69 


To 


120 


a5 


54 


Ta 


CONTINUE 

GC TQ 55 

peers a9) CT DLT (J),ABLT{(J),J=1,NI8 
De So =ag—-1,NIN 

MA=-ISLT(J) 

Mies os GO TO 59 

R{KA)=ABLT (J) 

emt MeN UE 

Geo 1S ¢ 
Sereno ICI BL T(J), 43LTUS) JL, MIN 
KA=IBLT (J) 

fn. Cia) Ge TC, 83 

Ctra )= NOL iJ) 

CONTINUE 

Cee 1G 59 

peeve Keg OO) (IT BLT (J), ABLT(J),3S=1,NIN 
DO 68 J=1,NIN 

hon PBT (J) 

Meee st tet )GO TC 69 

TST(KA)=ABLT CS) 

er TINUE 

CO tl 32 

Pee SOU CISL I (LS) GASE PTI) yp JH=1lsNIN 
oi J=1 NIN 

he=1BLT( J) 

Meets )Gh Tu li? 

Peer J=ABLT (J) 

NN PTINUE 

G10 69 

peer SOUT PBLICS) ,ABLT(J),J0=1,NI1N 
Otretrs J=),N TN 

metro (J) 

Pete LE .2.3G0O TO 119 

XH(KA)SARLT(J) 

eer Peres 

Como) ) 7 

mene GM SOS) (LOLT(J),ASLT( I) JH] NIN 
DO 120 J=1,NIN 

Kom WL ( I) 

fee. GD TD 53 

PM KAY =ABLT(J) 

CONT INGE 

Gey 7Oer119 

RPEADWRR, 3599 (IBLT(J) sA8LT( JI) ,J=1L,NIN 
DO 54 J=1,NITN 

KA=T BLT (J) 

Meine elLee. GO 10 #1 

SiR} =ABL T(J) 

Sey NUE 

GO me 53 

Meee, S9V( LT BLT (J) ,ABLT(J).J=1,NIN 
DO 72 J=l,NIN 





KA=IBLT(J) 
Smee. LE SON TC 7/3 
QANCKA) HABLT (CS) 
2, CONTINUE 
GG T0 71 
emer nUD (hy SIPC I BLT( J) eASLT(JS),J=1lethIn ) 
D0 74 J=1,NIN 
RA=TELT(JI) 
Mets AetE.C)GO TO 75 
RN(KA)=ABLT (J) 
fe CONTINUE 
GO TO 73 
Meme tha, Pe CIEL T(J) J&L rt J), JH1, NT) 
DO 78 J=ly NING 
KA=PBLTCJ) 
Peete. 1G TO 79 
IGUT(KA)=JBLT(J) 
W> CGWT TINUE 
Gmerit) 75 


Mee reo loCK CARD AND CORRFCT ALIICK DATA 
1S [SH=1 

LSWl=1 
eee Oi Kh; 1S) (I SBLT(J),J=)1,;NBLT) 

OTiee > J=1,N3LT 

Weed) Nes. TOLT(I))1G0O 10 386 

peo) CON  PNUE 

Gt) ia, fer gle yy FS 
mommy rer = (VB 7) CT SLT (Sd) JH) ey MOeLT) OL K 
Meet AT ( 1A, 5A1,5X%,' BLOCK NUMALY ae oe HAS INPDy QAI AG 

1’ BRROR!) 

pie (ts ,88), 1S) 
Pee ere 1 GY TO 188 
TSw=2 
Gum) 88 
Moo 00 190 J=1,h AKT 
Pete imee 4S) NE. TBLI(J))6G9 TO Lat 
1972 CONTINUE 
we | . 
GO TU 192 
7) 6S Pie 
ewer tat P30 TH le 
Meo 2READ(KKR, LS) CTiRT (5), J=1 fie T) 
Ole 4 J=),NAKT 
amet J) NE. IMRT(J)IGO TO 193 
194 CONTINUE 
JP=JP+1 
Comit 192 


mE SGIOCK DESCRIPTION 

Pe Pim ( 111, 5X,53('*!)) 

Boer oeMAT(1H 45X%,53('#'),/) 
Pei i (lH 35X,°*",12X,¥7H BLOCK 414; 
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MeoreCHARACTERISTICS,12X,'*' ) 
9] FORMAT(1H1) 
92 FORMAT(1H ) 
Seer OAT CIH 45 Xuet®',51X,%#!") 
MoeMRMAT( IH »5X,'**', 20H NHODEL U VwWwP RR, 
Mecteer IA Se Sli PR TH NO CO CB XD,1%,'#!) 
Meme TC LH 55% _8%' OX ,O012,5X% 1913 5,1X%, 1 *?) 
S60FORMAT(LH ,5X,!*",131 DATA PASSES ,12; 
meee OATA POIWTS ,14,13H NC. COEFFFS ,14,1X%,'*') 
BTOFURMATIIH »5X%,'*"',7H TZERC ,£11.4%,5!1 CT ,»,611.4; 
el 2 oe PAS AM 914, 1K, 4%!) 
PeUFORMAT{(IH »5X,'2', 1LOit INITIALILZIRG- , 
moore we SE LF LP X P E OF ST Oli eK J C,LE¥,?®?) 
Mme -MAT (LIL ,5X,'*1,3X,*c=INITIALIZE’, 1%, 
Meg ed 2, 512? ,3135212,1X%,'**) 
MBS HR ITE(KY,29) 
WRITE( KW,99) N3LOK 
WRITE(KW,93) 
WRITE (Kt 194) 
wee two 5) (HIS), J=2,KS) (NECK) Kal, KW) 
ARITE( Kb, 93) 
WRITE (KW,S6)NPB NDT yKF : 
We blnw. of EZ OT KP 
WRITE (Kw,93) 
WRITE (KN ,93) 
Sepa, OO) TH, L4E,ILE,ILPsIXHs IPH, LE, ING, Re, 
Ie Was 1, LU, TO 
ARITE (KY, 93) as 
meer AT (lt »5A4,°*', 32H COSFFICIENTS TO 3 IRPATIFIED, 
ee, 8k!) 
Mp lurORBMAT(LH »5X,'#*, 28H PARAMETERS Tu SE IGLNTIFIED, 
ey x  ) 
Meme vA (it 45%,8',2?X,301X%,F41l,1%,11).1%2's*) 
Semen y( it, 5X, '*?,2%,601X,341,)X%,11) ,13%5'") 
WRITE(KW,1O9) 
sme) 
Deerec J=1,XAV 
LEW(J)=o 
eee? KE }GD TO 14 
Pome )}.CT.J)GO TA 174 
(artes) = | 
ae it] 
154 CORTINUE 
uk=2 
I =0 
i= 
Dees K=1,KS 
CieereG J=1,KS 
Nemted 1=3,KS 
m9 J1=JT+1 
Weaeiect.J6)GO 10 138 
KXW( JT )=IXWR(K) 
leet JT) =IxXNR (J) 
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1c& 


ori 
1C6 
ee 5 
12 


a2 / 


P23 


mee l(ol)=JMak{ 1) 
sta i—) ) )/2+714¢ K-) ) 
UXvV( JI =LF el ( NT) 
Meera. 5) ANC. I.ED.KS)3}GO TO 169 
GO TC tc7 
ov=JV4 1 
Maeve oeEslsIXi)GO TO 116 
eet WW s lw2) (KXPC IW), EX CUM) IX 0J8), LX Od), IRE 1S I) 
JT=C 
GO TO 158 
eee! SEV I )Gi TO 111 
Oe ETRE lw2) (Kh Ame J) 1 XOM IY) SX JR) LXE ee), Se), 
wxK=6 
J fea 
GU TI 1.9 
ete 18S) Ch Xe Oa) ET Xt i) » SX ee) Ces) , SEE 
pom) 11 2 
Corin: 
COra VINUE 
CONTINUE 
MRITE(C KY, 93) 
meerletKw,]01) 
wal 
Coma 2d J=1 eK NP 
eee CS )=C 
Pett eoleKRPISO TU L277 
Pee adi )eot. JIG TG 127 
tert s)=1 
J) +) 
CONTINUE 
JK=8 
JV=HO 
gies 
Peel 7S J=1;6P } 
JAH=NGP (J) 
Jeo P(Ji-1 
Diemer eoe JG= 1, JA 
JM=EHIM+] 
c= Tt] 
Meee teeoi.e J KPGD TT 129 
KXm( JT) =J%4 
Peon )=LFP{ J“) 
Beek OO) D.C J.E 2. NGPIDLANDAI IGE.) 158 iti eee 
Suey 126 
JV=JV+t1 
Moye oe et SIXT)IGO TO 138 : 
WRITE CKwe il 24) (nKXvi( SW) pL XW CO Iw) dwell UK) 
=o 
como. 1238 
Memes lto-vi)GO TO 131 
WRITECKW,124) (KXNO JW) sLXWCJSh) » JW=1l, JK) 
JK=6 
JT=9 
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eo. TO 128 
Ree PARE 25) CKXW (SY) SL Xe Se!) » JW) UK) 
Suet 132 
Meo CONTINUE 
f23 GENT IWVUE 
me2 WRITECKW,93) 
WRITE(KW,39) 
124 FORMAT (LH poe 2K yO 4a) ll ae tat) 
Meee FURMAT (LI »5X,°*',2X,5(14,1X,11) ,L3X,'*!) 


Melee Ste PARAMETERS FuR SEA TRIAL 
Sree {15)-1 
v= IM+KS 
BH 136 JK=1,KS 
JReIn+l] 
JV=JSV+1 
peeve ict KS) =K (JK) 
Pay p=") ( JK) 
RVC JK HP (IR) 
M55 CONTINUE 
MECC ZO) HT0OUT(4) 
WRITE “BLOCK “DATA FOR REFE RENCE 
WRITE (KW:91) 
WRITE(KW,253) 
MeL ec (KM4, 291) SLOR PPB, 13. NK 
ee et )tT GL XY! BABIN SLOCK ',145% wlitb ',1l4,' PASSES*; 
Mees ou K 6S lUmf yy 145? GF ',14,° Th 82 Puce see 
WRITE (KN ,yS2) 
er Pet nw, 292 ) 
eee tra 1 (11 »lX.' THe FELLOWING ITS THE PR ImoeAT SLUCK *, 
meeewe hs USED IN THE SEA TRIAL.*) 
VRITECKW, 253) 
WRITE (KwW,293 ) NWRLOK 
Meemeoom at (itl »,52K,7RLOCK $',15,° DATA) 
pele (HW, 9 2 ) 
ne lie, 204) 
Ree oe Pt lH 64) X,"STATES OR DEGREES OF FeebOCt 18 Tris, 
ie eoCkK* ) 
Omer go> JK=iyKS 
ital) sale Oe TO 295 
Creme 96429752935 799,325+301),58 
Moos RRITE(K%,3 52) X54) 
Cee 9275 
BOT mM RITE(KW 1393) X0 JK) 
Gert 295 
oe WRITECKY, 34) X( 5K) 
GN TO 295 
299 WRITE (CK, 305) X0 SK) 
GQ TQ 2495 
Peo WRITE(KW,336)X( JK) 
Cert) 295 


=e oi Pee pots s'z ale ied ate ate a'e whe ale te So slo Se ate ate ale Se Se ate ale ale fe ale ale ale ne se whe she ale ale 
Chelle, balled Delliod alte? ball tated (nid bolded belted boli? told blood bal | Cd led baled tale tallied id paliad Ed balled | . . 
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Bol WRITE (KS. 
mao CONTINUE 


poe xX JK) 


Seer ijrAt (iH »1CAs*U SURGE K(1) FI/SEC ATL T=TZ Ue!, 
12s 1) 
Boer UPMAT( 11 ,JOX,'V SWAY ge) 17 Sie Ne alee Af tes 
ieee. 7) 
Meee IIH GtOX, sg 6©6vHEAVE) 6CX(3) FT/SEC AT THTZ a=!, 
ee, 78) 
Peo FGCRMATCULH »39X%,'P ROLL a 7 SG (l= ee ee 
IF 12.7) 
Mee UAT (lH fy lOX,'O PITCH X{S&) RAD/SEC AT T=TZ Q=!', 
Bel2.f) 
Beit FORMAT(1' ll X,'I YAw xa Vee SPOR T=172 Pa 
tale? et ) 
WRETE (Kise 32) 
WRITE (Kw, 393) 
Meee FOP MAT (IH »lX-*eFFECTORS USE IN THIS BLOCK!) 
DO 389 Jk=1,KMV 
Meme JK).EO.3)CO TO 309 
GO 10 (319 sold es (1 3 144 315, 38 oT gallik ; 


Seas) 
309 


jet ie (Ki4219) 
Cl 1G -Bie9 
WRITE (Ke, 320) 
GO TG 39°¢ 
WRITE CNM, 371) 
Ge TO 34.9 
meet Tel he, 322) 
GG TO 39° 

peel TE { Key 3 23 ) 
oa Tt) 359 

ARI TECKY,3 24) 
oe (0 360 
ARITE (RW, 325) 
om 10 349 
etre (RY, 326) 
Gee 39 
BRITE(Ka,327) 
CONTINUE 


CU Y sp Za TEP UO) aul 7 ee 
FORCES ART Freee.” 


319 FURMAT(LH 
B200F 02447 (14 


seer x, * | Ves .— S= "ir 
sreX, SEC BRAY DRAG ae 


Dee we YW ANG Lhe) 
eemeeorm Ar {i,t slmeX, * SHRIU) -— Uld6)-U(Y) ANGL=AS TR °2 00a) 
mo eee (iit 4» ROX, TP RIPr Li dA - ulin) RPS 5» ULI) BPS/ Sue 
eee ret lH »lCX,*THRUSTERS - U( 12) Yu, UI132) YAP, 


wee) LEWD, UCI15) ZAFT 3+U=+V¥,4M,—Zy-N °) 
SZzterPORMAT (IH ,1CX;* eae St — GAUSSIAN WAIL Te ADDITIVE Paebeg 
Pee oerNoeMNEASURE 1 mS Eo) 
Bed FRPMAT CL Fe Creal TERMS -“APOEO [i 1h2 Seeecr sae 


Ze} 
AR Daa Sass 


eo eer (11 ,1CX,* CENTER OF BUCYANCY NC 
ert OMA IH ,lf X,'NOISELESS TRAJECTORIES 
CIRCULATED? } 
Meee FI9).E0.9)GN TO 428 
WEL TE (KWe@29) 
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MeoCrURMAT(IH ,1CX,'ANGLES ARE INTEGRATED P,2,8 RES'ULTIN!G, 
mec nee VentiClLe TRAJFCTCRY? ) 
mee IF (ME(20).FD.39)G0 TO 33) 
WRITE (KW,331) 
Mee ORM AT(LH ,1WK,' VEHICLE ANGLES wILL BE PLOTTEG! ) 
3350 WRITE(KW,92) 
MRI VECKY, 332) 
eer OrmAl (iH ,»,lX,'NOISE GENERATICN PARAMETERS, 9(6),2(5', 
Meme PROCESS; R-AEASU CEMENT! ) 
Peer Pemewiy o55)1S,90(5),5=-1,KS) 
eo | Md yf 1X, FOC J)-' ,6(2K%,13,'=!',F13.4)} 
WRITE (KS.,334) 05,R(J),J=1,KS) 
Seem ir yt X, RL S)-* ,602X%,15,'=',FV3. +) ), 
MRT TECK4, 335) 
emer eT (li LX, “WE LORT ING MATFICES, INGE), Mel), RRIL ¢, 
Moles Weert, AND MOPEF USES RAF) 
ted Or, 336) (5S pQN( IS) ,J=1,KS) 
eet tte 4g 1X, ONC I) ',6(2K,13,'=!',F1L3.4) ) 
Meee ( em, 33774 3,RN(5),J=1,KS) 
eC tH 5 1X, *t NS) 'y6(2%,13,'=',F12.4)) 
Bel een!» 97 ) 
Wolo tn: 253) . 
WRITE(KWN,333}) 
eer td fg LX, PF INPUT FUNCTICSS JSED IN THIS SLOCK*) 
poeett er. E.G GO TM 339 
WRITE C KY, 319) 


ARETE (Ki) 340) | 
B450FORMAT (LH s12X, MERCURY TANKS - UCL)-UC2) LIST CoMTR', 
1' OL, L-RESERVCIR,2-ST33y2-PORT? ) 


WRITE(KY,341) 
errr CORMIAT (TH yg l2rx,P§ AGERCURY TANKS — J14)-U(5) ‘Eee, (Caen 2g 
mew. a—er oD, oT Tt) 
Te ( KvieS 4 2 } 
eee nT Oe 51 2X, MATES VB TAMKS=— Ul6)-U( 7) Tele Ae 
emi paweyY CONT 20L ,»6-FW:, (-AFTI* } 
WRITE (KY, 343} 
eee eA T {1H ,12X,'* TANKS STEP FUNCTION INPUTS — Al pecs: %; 
Meee ST= START TI“E,USTSHSAMPLIT1De IN LBP C1SulIp 
WRITE(KW.345) 
Bee> FURPAIT( 14H »15 2) er GaTIVe TST MeANS NO STrP GENLRATILU') 
Pee etn 3 844) (Sy Jalsa le) 
eer ttt yoy! TANK NUL, 3KA,I LOCC. tye STEP! 1S eee 
JV=] 
JR=16 
DO 346 JT=1,7 
WRITEC KW, 347) UT, JVs (TST0J),J=IVe IP) 
WRITE(KW, 348) J3T, JV (UST (S),J=IVeJP) 
ou + } 
JR=JR+10 
346 CONTINUE 
Deere FOP AT( 1H 5 1X," TST=H=',14,5X914,2X,10( 1XsF5.2,1%)) 
Pree FOR AT{ih ,1X,'USTH='+14,5X%,14,2X,10(1X,F38.2,14) } 
eee (NH, 9) ) 
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ei tet KW, 253) 
WRITE (44,338) 
Meme i (jE(3).E90.90)6G0O TO 349 
WRITE (KW,321) 
WRITE (KY 4359) 
meee Oe AT (et 43} 2X,*SHROUD ANGLES - @C=DELTA P,9=DELTA YY") 
JV=71 
JR=EC - 
JT=8 
BRITE (ie, 351) 3 
Mimo RGA) (it gl2X-*SHRUUL STEP FUNCTICN INPLTS - AT Most, 
Pies SI —START Ti estIST=AYPL. IN 2ADT ARTS!) 
MRI TE (iw, 245) 
Peery os 7 J) (J yJ=1, 1 ) 
Meee AT (ii , 3X," TNPUT MD.',2X,'°UUC. vs 
meee ot eee 1253X)) 
Peete i ies 7) JIT, SV (TSI) ,J=UV~,d8) 
BeepetKhyW ,348) JT, JV ,-CUST(J),J=JV,J8) 
JV=JR+1 
JR=JP+ALDS 
JT=JT+1 
prebevny 7347) ITs JVs 07ST), JEUV s Je ) , 
: wee pets 348) 5ST, JV, (UST (I) ,»J=dV,y JR) 
Meo NRITE(KW,92) 
eevee ous7 6c O.! 9G) TO 355 
wel Pe (KW, 322) 
v=?) ' 
JRelin 
JT=)6 
Peeler ARW y 353) 
Seon i (itl ~lZ2xXs? PROP STEP FURCTIGN INPUTS — AT meOST ¢, 
(etee et St—=STARIT TI4E,USTHAMPL. IN RPS OR S3PS/SECVD 
WeITE(KW,345) . 
Werte (ky, 352)(5,J=1,19) : 
Pere (hea 4G4 7) JT, SV A(T ST( 3), J=IV,JR) 
ppm, 243) IT, IV, CLST( I)» JHdV a IR? 
ae J +1 
yet | 
IRIs le 
eee. Serpe IV GCUST Ca) IH ove 
Pewee poe PIT VC UST (I), JE IV, SR? 
ae “eer te CGO TO 63455 
WRITE (Ke, 92) 
VereistE (KW, 2 D3) 
Wet ve (Kywy91) 
PRT PEt KRWY 253) 
WRITE(KW,.333) 
Diemer) © EQ0.C)G9 TO 354 
WRITE (KW,92) 
WRITE (KY, 323) 
JV¥V=111 
JR=AL2Z0 
WRITE (KW, 356) 


eS) 
Oy 
og 
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Bee FORMAT (1H yl2X,tTHRUSTER STeP FUMCTICN INPUTS - AT M!, 
Peet Pati SheSTART Ti4ce,UST=@4PL. If RPS'*) 
WRITE(KW,345) 
WRITE (KW, 252) (5,J=1,10) 
pm S57 Jl=12;15 
i) Wee ras 34 oT ys SMe TST (J), J=IV, dK) 
WRITE(K%, 348) 57T,J5V (UST( 2) ,J=IVyJR) 
JV=ESR+1 
wee JR F1¢ 
mf CONT INUE 
WRIGE( 88,92) 
mor Mt (19).60.5)CG0 Th 353 
WRITE(K% 1329) 
pemei? SOU 
mod WRITE (KE, 35°) 
See AL (IH eX, PT AIGLES ARE wll IRTEGRATECY ,ouT PRL *, 
Meowe? PUNCTIGR ThPUTS') 
me Pe (ME (2e).EQ.9)G0 TO 361 
WRITE(KW,331) 
60 TU 362 
Bol "WRITE( KW ,363) 
eee AT OTH 9 LEX, * VEHICLE ANGLESY PILL ACT BE PLOTTED) 
Bo2 WRITE(KW,92) 
WRITE(KK»367) 
meme na AP (1H 312X,'ANGLE STEP FUNCTION INPJTS — Al BOOST", 
Meets SI=START TIME, UST=AMPL. TR RADTANS?) 
VRITE (Kyi, 342} 
Memeo Nit lt sloXs*VERICLE ANGLES PHI, Trig TA,?S1 = UTE)”, 
eee )] 
JV=151 
JF=)] 6% 
mie Ve Kii9 245) - 
MRIVE (KM 7 252)05,5J=1,179) 
Poa 269m 1=-16,18 
WRITE (KW, 347) 5ST, IVs (TSTOI) se JEUV IR) 
yl Weel 242) IT IV, CUSTII) JH dIV J) 
eter + 
Jha te 
Bog COMTINUE 
MORI TE CRW, SZ) 
WRITE (Kil, 364) 
Seaway (ili gL 2K,'UCS) -— STARTING VALUES pyr ALL pr *%, 
eeeeer EC TOR STEP FUNCTICNS®S ) 
JR=6 
OW, 265 JV=1,13,6 
WRITE( Khle 366) (J,U0JS) »JSJ=JV1J2) 
o> OearTM]H ,1X,'U(JI-',6(2X%,13,'=',F1 3.4) ) 
wie= Jie 6 
Boo CUMT INUE 
WRITE(CKW,92) 
eer te (RN, 3/7.) 
eweomeemeaayT( itl ,)X,'EHD OF INPUT FUNCTIONS THIS BLOCK") 
WRITE (KW, 253) 
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WRITE (KW,91) 
WRITECKW, 2593) 
WRITE (KW,271) 
tte (5) .EQ0.9)G0 TO 404 
Seer Oi. Adet iri »«lX,'*K( J) -— TOTAL STATE VECTOR USED FO® SEt, 
meee re CEA RAT TUN ) 
WRITE( KW, 372) 050,KA05),2=)],%X) 
Serr yA iit! 1A, *X(J)-—', G02K%,15,'=',F12.4)) 
Welle (KW, 92i 
WRITE(KW,253) 
melTeE(KW,91) 
WRITE(KW,253) 
WRITECKiW,3 74 ) 
eer in: At (led gt X,* XH S)-— STARTING STATE ViC TER ©) 
reer, 75) (5, XC) sy Jal. KX) 
meee Ween TC ird glk, t XR (J) '§,46(2X%,13,'=', 12.) ) 
Pee lT et Kw, 92) 
WRITE KW, 253) 
WRITE(KW,91) 
MOR LTE (Ky 252) 
WRI TP (Kw, 3/75) 
Meera t (C1'y glxX,'PC J) — TOTAL PaRS4BETER VECTOR ) 
ete (KW, 3 PHI (1 POI), J=1, KX) 
Seeoer irAT (irl »iXs'PCJ)—-',6(2X%,139'=',713.%)) 
Meet (Kay 92 ) 
meet te (oe, 253) 
WRITE (KW, 31) 
mei 1G (ie, 253) 
peor tetkh, 275) 
wey =KX+ 1 
WRITE(KHs3 7/5) (03,P(J),jJ=JSV,KIP) 
VRITECKW, O92) 
RET TERY, 253) 
WRITE (M.91) 
mee LTE ( KM, 2523) 
WRITE (KW,277) 
Seer ORFMAI(IH ,1X,'PtilJ)- STARTING PARAMETER VECTE2"] 
PRIiTeECx, 378) 03,PH0J),J=15KX) 
eager ait iti 4) X,tPPtJ)*,6(2X%,13,'=',Fl3e4)) 
MRT TE CK. 392) 
Wee Teter, 253 
MeRiteE(Kw,9! ) 
RRL E(KS, 253) 
WRITE (KW, 377) 
WRITE (KM 43273) (5,PH(JS),JS=JV_KNP) 
MRITE(KW,92) 
WRITE(KW,253) 
Werte t(KhwW,9 1] ) 
WElITea(Kw, 253) 
WRITE (KW ,381) 
emer CRMAT( 1H ,1X,'FH( J) -— DIAGONAL OF ERRIR COV. MATRIX®) 
JV=1 , 
DO 3282 J=1,KEH 
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WRITE (KY, 333), EH (J) 
B83 FORMAT(IH s1X,tEH(I)—'45X_415,5X,F 20.12) 
=J4JSV 
JV=IVEL, 
382 CONTINUE 
WRITE( KK, 92) 
WRITE (KW, 252) 
WRETE (KW, 91) 
404 WRITE(Ky,253) 
WRITE (KN, 379) 
379 FURMAT(LH 41X,¢10UT- OUTPUT DESIGNATION VECTOS*} 
Weel eves 3 Soe ( J, 1OUT( J), J=1 51.0) 
BBO FORMAT( Id IX, tPOUTC SD E21 2X,12) 12", 14) ) 
ARI TE(Ke,92) 
HPITE (Kiiy 253), 


ss - te of ° te of ut ° vos #. ale 4 oy Bo of ale « 
NC ere ee ete ic ojo 40 oy eis ea aie OIC OK To oie Sit 3S HEME oie sie aig He ie oie oie sie st Re seipteale st wots = 
em) WF BLOCK D 1A GuTPU 
ENT a . DA UT 
+ fos te «' Os fe of ‘ On es Hi e ats ' : : 
eer rm e yays Ays 2m yo He AS Aye NS x 3S 2k SHS HC OC ok Sic OK oie Be vic ok ok she ais aie oh ots ok sz ve sie ate ot ae ote ste sic sk ote Sr SS cece See ee ee ee 


RUN A Seeeerrite oo SEA TRIAL FOR THIS BL CCK 
WRITE CK, 364) °X05)yJS=1,KS) 

Meee AICI 41X,'BEGIN SEA TRIAL— X{J}= °, 

moe ast 143.6,2%)) 

ree SEATR II ASD,P,X,XN) 


TEST FOR A VALI) SEA TRIALSIF RT ,ABOPT THIS 32L0CcK 

Met iABO,5S.10NiE)G) TO 134 
PE (¥REFWNE.1IGO Ta 133 
N30 165 1P=1,NP3 

180 2EAD(KR,15) (1 eRT(J) Jal yNMRT) 
DO 187 J=1,NART 
Dette ( 3) Ne. TMeT(J))GC TO 196 

127 CONTINUE 

185 CONTINUE 

168 WRITE(Ke,135)N38LGK | 

135 FURSAT (5X, "ELCCK NUMBERt,15,5X,'SEA TRIAL ABDRT!) 
G0 TO 19 


fe he Se gt ate ste ate wo ale we le abs ale de Me nto ales! le te whe be ote we ole alle ole ate ate a ale ole we ate ale wt -'e wt ote Pe ate te ate ate Se ole oh ot, 
: PS ead “ge #1 * 74> > Mgr Mge Ag> Mgr ye Fo Mgt 45 OE OS 


cmeens Se 36 ok TE ge Ue Shs SSE elie ait eh eae Ge REO ray ar Ws SE ic oad tae ed mA OHA ard tarred ere, chy Sah Sas tet 
eee ATA GEWSXATED BY THE StA TAeTAL 
134% WPLOT=NFLOK 

NCCNHNR LOK 

meme SION? UN, 2 yZNy LOUIIZIGADT NLC) 


Me 4 2. . [hc Ye ft eet Deets alg AOE cael PO POA is oe 
SRE Bees aries ese Ot sis Se SK 14 os he Sit Se SK esis Bo Se Me le 246 So ME HS Sie a Bo Bos Se Sis ae sy Ss Spiegs eye eae apernyn ie SOA ASS ones renee 


menNeOrPr THE NOISE GENERATOR IN Toe OCEAN Y SerPCle 
Peet o) i. OhGO TO 178 
JW=NDT#KS 
DQ 189 JK=1,J4 
ZNO JK) =Z(0J5K) 
nso CONTINUE 
Cte 179 
178 ME(6)=) 


“Do 7e 





, ate ote whe ale ol We sie we whe ate ale ale ate ole ote abe ole @ yle ste ste abe ote ate ate ate ale a whe we ote te ole we Jo s'o ole 
~ “> # et, &,% ~ = ¢ °,* gre - oy bd eae tee m “> Ss Fem Mes ge Fr Oye 3 eu @ + Pa . 
et by SR / SND S SSS SET ed MT ts a aE ls Be bo is ed Ts dd ed ee om > 9) SAS “Ie ee “See %S me ce 0 





why ate ale 1 4 ‘ He a%e 6 De »! 


MeeeGiN IDENTIFICATION PASSES OVE® SFA TREAL OATA 
m2? DO 11 I[P=1,NP6 3 
REAC(KR 40 7KF KP 

Caer e tel GO 10 137 


« a « el p UJ 4 J aoe. $ 1, J, % ‘ a Li (een t t a 
ab, ate a8 Ve Se at wh: ale o'er whe ale we ate SU nto ole ale ale So ote ate ole whe ale al ale ah oly ate nin we oe, le ats whe of 1 we ot eo =e »' 
Ct “> “ Lal be ”~ ~~ -c “~ rf “> 26 “ a: “> “.~ “+ > at fi te ”~4° wv, 1 od bed " Cd teed “> - “- -;> a > a= PS i ie eee ies wae ae -,* 4 ve > ihe > ré 


Bee ENDED KALMAN FILTER PASS OVER DATA 
GO TO il 


\& ale whe xte ate we ale Ste ate ale ole ate Se ole ste we we Se s! 
bd ted “4~ bd Dood by hed “~~ Ce ial aN “~~ “> Cd ted yy “Gy > 


al ate wah a'e se whe als ate ate stl ale ale Be wt. ate alo 3s! , Sf '  ! U 
eT ed pd eas ed od Rolie bs bela Dd elle tad 


Mise SO Ga Ags cis vik ey 8S eee 
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